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ABSTRACT 


A  computer  program  for  automatically  damping  the  polhode  motion  of  the 
Miero-Eleeirostatically  Suspended  Gyro  (M1CSG)  is  presented.  Test  results  are 
presented  that  demonstrate  successful  automatic  polhode  damping  on  two  gyros. 

The  fundamental  characteristics  of  polhode  motion  of  the  MESG  rotor  are  summa¬ 
rized.  The  techniques  for  monitoring  polhode  motion  using  Mass  Unbalance 
Modulation  (MUM)  are  described.  The  polhode  torquing  equation  is  derived  and 
the  spin  motor  cont rol  electronics  tluit  implement  the  torquing  equation  ax'e  desci'ibed. 
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SUCTION  1 


INTRODUCTION 


Polhode  damping  is  a  necessary  function  in  the  operation  of  a  Miero- 
Kleetrostatieally  Suspended  Gyro  (MKSG)  since  it  is  the  technique  to  force  the  spheri¬ 
cal  rotor  to  spin  about  its  axis  of  maximum  inertia.  Furthermore,  it  must  always 
spin  in  the  same  direction  alxntt  the  axis  of  maximum  inertia.  The  primary  design 
goals  of  automatic  polhode  damping  are  reliability,  low  cost,  and  minimum  lime.  The 
polhode  damping  logic  is  performed  in  the  digital  computer  used  for  navigation. 
Therefore,  low  cost  is  directly  related  to  low  computer  requirements.  It  is  particu¬ 
larly  important  to  minimize  computer  memory  requirements.  The  minimum  time 
requirement  is  related  to  fast  reaction  applications  of  the  MICRON  system.  The  rotor 
must  he  suspended,  spun  up,  thermally  stabilized,  and  jwlhode  damped  before  the 
alignment  and  navigation  functions  can  begin. 

Polhode  damping  has  been  successfully  accomplished  ns  is  reported  in 
Section  VU1.  A  detailed  description  of  the  automatic  damping  program  is  given  in 
Appendices  C  and  1).  Two  important  features  ot  the  mechanization  are  its  resilience 
and  that  no  calibration  of  individual  gyros  is  required.  The  program  has  demonstrated 
Us  ability  to  recover  from  major  errors  similar  to  out  of  specification  hardware 
operation  ami  successfully  damp.  Two  gyros  were  automatically  damped.  The  auto¬ 
matic  damping  parameters  were  entirely  based  on  one  of  the  gyros.  The  other  gyro 
has  never  been  calibrated. 
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SECTION  II 


DEFINITION  OF  THE  PROBLEM 


Polhode  motion  occurs  in  any  freely  rotating  rigid  body  with  unequal  moments  of 
inertia.  A  polhode  is  the  path  which  is  traced  out  by  the  spin  axis  on  the  body  when 
viewed  in  body-fixed  coordinates.  The  motion  of  the  spin  axis  with  respect  to  Inertial 
space  Is  the  herpolhode. 

The  component  of  the  spin  vector  along  the  angular  momentum  vector  of  the  body 
is  a  constant  irrespective  of  polhode  motion  if  no  external  torques  are  applied  to  tho 
body.  For  a  nearly  symmetric  body,  such  as  the  MKSCJ  rotor,  tho  herpolhode  is  vory 
small  so  tiuit  the  spin  vector  is  essentially  inertially  fixed.  The  polhode  motion  is  not 
small  ami  the  spin  vector  may  move  drastically  with  respect  to  the  MESG  rotor  principal 
axes. 


i 


For  a  constant  energy  system  there  are  two  stable  axes  of  rotation  for  which  there 
is  no  polhode  motion  as  shown  in  Figure  l.  These  are  the  principal  axos  with  the  largest 
anti  smallest  moments  of  inertia.  Any  practical  system  dissipates  energy  duo  to  non¬ 
perfect  body  rigidity  or  external  influences.  For  this  reason,  only  rotation  about  the 
axis  with  the  largest  moment  of  inertia  is  both  stable  and  without  polhode  motion. 

The  equations  describing  polhode  motion  are  derived  in  Ref  1.  The  results  will 
be  briefly  summarized  here. 


If  the  three  principal  moments  of  inertia  of  the  rotor  are  A,  R,  C  where 
A  *  D  *  C 

-A  (¥>  “n “■  •  VA 

S,  ■  TttK'-a  • 

“c  “  (“c")“A“n  '  Vc 


<l> 
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the  angular  rate  of  the  rotor  in  rad/sec  and  (Q^,  Q^,  Q^J  is  the  applied  torque  vector. 

The  solution  to  Eq  (21  cannot  be  expressed  as  an  explicit  function  of  lime  in  dosed  form 
since  it  involves  elliptic  integrals.  Solutions  not  explicitly  containing  lime  are  derived 
in  Ref  1.  For  the  case  of  no  torque  driving  functions  the  solutions  are  closed  trajectories. 
The  trajectories  either  enclose  the  *  A  axes  or  the  »  C  axes  depending  on  the  initial 
conditions.  Therefore,  the  trajectories  arc  classed  as  A  family  trajectories  or  C 
family  trajectories,  respectively. 
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A  ■  AXIS  OF  LARGEST  MOMENT  OF  INERTIA 
B  ■  AXIS  OF  INTERMEDIATE  MOMENT  OF  INERTIA 
C  ■  AXIS  OF  SMALLEST  MOMENT  OF  INERTIA 


Figure  1.  Polbode  Patterns 


The  trajectory  that  divides  the  A  and  C  families  is  called  the  separating  polhode. 
It  is  defined  by  the  equation 


A  spherical  coordinate  system  will  be  used  to  uniquely  define  each  polhode 
trajectory.  The  +  A  axis  will  be  used  as  the  north  pole.  Latitude  is  measured  from 
the  C-B  plane  toward  the  A  axis  and  longitude  is  measured  in  the  C-B  plane  with  the 
+  C  axis  at  zero  longitude.  Each  polhode  trajectory  is  uniquely  defined  by  its  latitude 
at  either  0  or  180-deg  longitude  and  so  this  number  will  be  used  to  identify  the  polhodes. 

The  latitude  number  for  the  separating  polhodes  is 


The  latitude  ranges  for  each  of  the  four  polhode  families  are: 


Family 

latitude 

Longhudo 

»A 

0  5)0  deg) 

0  deg 

-A 

(-0S,  -90  dog) 

0  deg 

(Odeg,  »0g) 

Odeg 

-C 

(Odeg,  +(^) 

180  deg 

Polhode  motion  is  periodic  since  the  trajectories  are  closed.  The  period  is  a 
function  of  polhode  latitude  and  the  A  or  C  family.  For  the  A  family  the  period  is 


where  8  is  polhode  latitude  anti  angular  rate  of  the  rotor  at  the  0  or  IHO-deg  longitude 
point  in  the  trajectory.  The  period  for  the  limiting  case  in  which  the  polhode  latitude 
approaches  80  deg  is 


(«) 


Therefore,  the  frequency  of  pclhotie  motion  In  the  A  family  can  be  written  in  terms  of 
two  rotor  parameters,  T^  and  0g,  as 
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The  frequency  of  polhode  motion  in  the  C  family  is 
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The  period  for  the  limiting  case  in  which  the  polhode  latitude  approaches  zero  is 
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Polhode  frequency  as  a  function  of  polhode  latitude  is  plotted  in  Figure  2  for 
°g  45  deg  and  T.\  2.  #3  sec.  The  slope  of  the  frequency  curve  is  infinite  at 

45 -deg  latitude  and  the  frequency  is  zero  at  that  latitude. 

Rotors  currently  in  use  in  the  MKS(»  have  values  of(^^)ai«l  (^—)  in  the  range 
of  <10  *,  0.5  n  1 0” 1 »  with  Oj.  very  close  to  45  deg  and  in  the  range  3*0  see.  Rotor 
speed,  *  ,  is  2500  Hz,  The  third  degree  of  freedom  in  the  differential  Kq  (2)  whP'h  is 

\mi'  ° 

-■jj—  can  be  approximated  by 

(¥)  ■  It2)  -  (¥)  “»* 

\-C 

Solving  the  right -kind  side  of  Kq  tlO)  for  “-using  a  second  order  approximation  gives 

(*£)  |(¥)'(¥>l  !'-(¥)  (¥>l 

and  therefore  Kq  (10)  is  accurate  to  2  x  10  .  in  a  practical  sense,  there  are  only  two 

degrees  of  freedom  defining  the  pollunle  motion  in  this  application.  Those  degrees  of 
freedom  can  be  expressed  as  T^  and  0^  deftned  above. 

Conformal  mapping  util  bo  list'd  to  transform  polhode  motions  on  the  surface  of  a 
sphere  onto  the  infinite  plane.  The  spin  vector,  (w. ,  w„*  w*c),  tn  rotor  coordinates  is 
mapped  into  the  V,  V  plane  by  -  11  e 


U 


V  *  .111 

mc 


(12) 


w  ti  rut*  tnr.oi 


Figure  2.  Po'  ado  Frequency  vs  Polhode  latltudo  for  Gs  *  45  Deg  and 
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This  transformation  has  tho  property  ttuit  great  circles  arc  mapped  Into  circles 
in  the  U,  V  plane.  Great  circles  through  the  C  axis  are  mapped  into  straight  lines 
through  the  origin.  Figure  3  shows  the  Important  great  circles  which  wilt  be  used  as  ti*e 
grid  for  polhode  plots.  The  great  citclos  In  the  A -II,  B-C,  and  C-A  planes  are  shown 
as  veil  as  the  two  great  circles  defining  tho  separating  polhodcs  (0g  *18  deg).  The 

areui)  enclosed  by  the  separating  polhode  lines  represent  from  led  to  right  the  -A,  *C, 
and  +A  families.  The  -C  family  It,  represented  by  the  area  outside  of  ’«>th  separating 
polhode  circles  in  the  U,  V  plane. 

An  Important  property  of  conformal  mapp’ng  is  that  the  angle  between  two 
intersecting  linos  on  tho  sphere  is  preserved  when  tho  two  linos  uro  transformed  on  e 
the  U,  V  plane. 
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Figure  3.  Conformal  Mapping  of  the  Surface  of  the  Sphere  Onto 
tho  Infinite  Plane  (08  *  45  Dog) 


Figure  4  shows  polhode  trajectories  in  tho  tA  and  *C  families  at  10-dog  latitude 
intervals  and  one  trajectory  in  the  -C  family  at  40-deg  latitude.  The  distortion  intro¬ 
duced  by  the  transformation  of  points  distant  from  *C  axis  should  be  recognised.  On 
the  sphere  these  trajectories  are  approximately  elliptical  in  shape.  The  direction  of 
motion  on  each  trajectory  is  shown  by  arrows,  As  n  memory  aid,  the  right-hand  rule 
defines  the  direction  of  motion  in  the  A  families  and  the  left-liand  rule  defines  the 
dlroction  of  motion  in  the  C  families. 


The  attitude  readout  mechanism  of  the  MKSG  for  navigation  function  is  mass 
unbalance  modulation  (MUM)  produced  by  intentionally  shifting  the  mass  center  of  the 
spherical  rotor  approximately  along  the  -C  axis  from  the  geometric  center.  The 
pcndulosity  vector  is  defined  as  the  vector  from  the  geometric  center  to  the  mass  conter 
and  ts  approximately  1(1  pin.  long,  The  rotor  will  spin  about  the  mass  center  assuming 
thcr*  is  no  forcing  by  the  electrostatic  suspension  at  rotor  frequency.  The  spherical 
rotor  will  appear  to  wobble  at  rotor  frequency  with  amplitude  equal  to  the  component 
of  pcndulosity  orthogonal  to  the  spin  vector.  This  component  of  pcndulosity  is  called 
the  MUM  vector  (with  direction  reversed). 


Forcing  by  the  electrostatic  suspension  at  rotor  frequency  is  not  negligible 
except  al  the  notch  frequency  of  2430  ha  or  below  400  hz  as  shown  in  Figure  A-2  of 
Appendix  A.  When  damping  is  performed  at  rotor  frequency  of  2000  hz  the  MUM  vector 
is  50  percent  larger  than  at  2430  hz.  The  equations  relating  MUM  vector  to  pcndulosity 
vector  and  suspension  gain  and  phase  are  given  in  Appendix  A.  For  zero  gain  tho  MUM 
equation  of  Appendix  A  reduces  to: 
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Figure  4,  Polhodo  Trajectories  nt  10-I)eg  Intervals  in  -A,  +C, 
nml  >A  Families  and  40-Dog  Trajectory  in  -C  Family  (08  ®  45  Deg) 


where  P  Is  the  penduloslty  vector  awl  w  is  the  spin  vector  and  the  MUM  vector  Is 
normalized  for  maximum  length  of  unity. 

For  nonzero  forcing  the  length  of  tho  MUM  vector  is  changed  and  the  phase 
of  the  signal  is  changed.  The  computer  compensates  the  net  phase  shift  of  the 
MUM  vector  and  the  MUM  vector  is  normalized  to  its  maximum  value.  Therefore, 
the  compensated  MUM  vector  is  defined  by  Kq  (14)  if  forcing  gain  and  phase  are 
constant,  if  rotor  speed  changes,  the  forcing  gain  and  phase  will  change  and  so 
MUM  vector  will  change  as  defined  by  the  equations  in  Appendix  A. 


The  direction  of  tho  MUM  vector  as  described  by  Kq  (14)  is  shown  in  Figure  5 
for  one  trajectory  in  each  region. 

Tho  MUM  vector  modulates  the  capacitance  as  seen  from  the  cavity  electrodes. 
This  information  is  demodulated  and  sent  to  tho  computer  as  two  vectors,  om  and  Pm 
which  represent  the  cos  and  sin  components  of  the  demodulated  MUM  signal.  Physically 
«M  and  Pm  represent  Ihe  position  of  the  MUM  vector  at  0  and  90  dog  of  one  rotor  revo¬ 
lution  which  is  relntlve  to  the  phase  of  the  demodulation  reference. 

The  amplitude  of  tho  MUM  signal  is  modulated  by  the  poihodo  motion  ns  can  bo 
seen  in  Kq  (14)  since  die  w  vector  follows  the  polhode  trajectory.  For  the  case  In 
which  the  penduloslty  vector  is  exactly  along  the  -C  axis,  the  MUM  magnitude  is 
minimum  when  w  is  in  tho  A-C  plane  and  is  maximum  when  w  is  in  the  A-B  plane  for 


H 


Figure  5.  MUM  Vector  Directions  in  ±A  and  *C  Families 
(6S  45  deg,  Ta  b  2.83  sec) 

A  family  polhodcs  and  in  the  C-D  plane  for  C  family  polhodes.  Therefore,  the  domi¬ 
nant  frequency  in  MUM  magnitude  is  second  harmonic  of  polhodc  frequency.  The 
locus  of  unity  MUM  magnitude  is  on  the  A-B  plane. 

Due  to  unintentional  imperfections  in  the  rotor  a  component  of  the  pendulosity 
will  lie  on  the  -A  axis.  In  the  past  this  component  of  mass  unbalance  has  been  the 
sole  means  of  distinguishing  the  ±A  axes  by  defining  the  mass  unbalance  to  be  on  the 
-A  axis.  It  is  very  important  to  always  damp  the  rotor  in  on  the  same  axis  so  *A 
axes  must  always  be  identified.  The  pendulosity  component  on  the  -A  axis  hns 
always  fallen  in  the  range  of  (1  percent  to  0, 2  percent  of  total  pendulosity.  Of  course, 
there  is  always  the  danger  of  manufacturing  a  perfect  rotor  which  hns  no  pendulosity 
component  on  the  -A  axis  and  hence  the  sign  convention  fails.  An  alternate  sign 
convention  now  implemented  is  to  intentionally  rotate  the  pendulosity  vector  approxi¬ 
mately  4  deg  toward  the  -B  axis,  Mass  unbalance  on  the  B  axis  causes  no  degradation 
in  gyro  performance  while  mass  unbalance  on  the  A  axis  causes  g-sensitive  drift 
rates. 


Small  mass  unbalance  on  the  A  and  B  axes  rotate  the  locus  of  unity  MUM  magni¬ 
tude  away  from  the  A-B  plane.  The  locus  of  unity  MUM  magnitude  is  defined  by  the 
plane  orthogonal  to  the  peaduloaity  vector  ao  mass  unbalance  on  -A  axis  rotates  the 
plane  about  *B  axis  and  macs  unbalance  on  -B  axis  rotates  the  plane  about  -A  axis. 
The  dissymmetry  of  the  pendulosity  vector  relative  to  the  polhodc  pattern  causes  the 
two  maxima  and  two  minima  of  MUM  magnitude  per  period  to  bo  unequal  in  general. 
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Figure  6  shows  the  great  circle  locus  of  unity  MUM  magnitude  as  a  heavy  line  for 
pendulosity  on  -A  and  -B  of  10  percent  each  and  0g  =  45  deg.  Several  polhode  tra¬ 
jectories  are  also  shown  to  illustrate  the  major  variations  in  MUM  magnitude 
patterns.  The  approximate  points  of  high  and  low  maximum  and  high  and  low  mini¬ 
mum  are  also  shown.  Notice  trajectory  3  in  the  C  family  has  a  double  maximum 
near  -B  axis.  Also  the  trajectories  1  and  5  in  the  neighborhood  of  the  C  and  A  axes 
have  only  a  single  maximum  and  minimum.  Figure  7  shows  the  MUM  magnitude  time 
histories  for  the  same  five  trajectories  of  Figure  0.  Each  time  history  plot  is 
started  on  the  great  circle  segment  between  +C  and  +A  axes  and  continues  for  slightly 
over  one  period. 

The  most  prominent  features  of  all  polhode  trajectories  can  bo  summarized 
with  a  plot  of  the  maxima  and  minima  MUM  magnitude  versus  polhode  latitude  as 
shown  in  Figure  S.  The  difference  between  the  high  and  low  max  or  a  max  is  shown 
in  Figure  9.  The  peak  to  peak  amplitude  of  MUM  magnitude  is  shown  in  Figure  10. 
The  angle  from  the  trajectory  normal  to  the  MUM  vector  can  be  visualized  from 
Figure  5.  The  angle  is  plotted  versus  latitude  for  the  max  and  min  points  on  the 
trajectory  in  Figure  11. 


Figure  6.  Five  Representative  Polhode  Trajectories  and  Locus 
of  Unify  MUM  Magnitude  (dg  45  deg) 
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Figure  9.  Difference  Between  High  and  Low  Maxima.  A  Max  (45  Deg  Separating 
Poihodc,  0. 93.  0. 0?  l’emlulosity  on  A  and  U  Axes  Hesoeetlvely) 
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Figure  U.  Angle  Between  MUM  Vector  and  Trajectory  Normal  at  Min  and  Max 
Points  in  *C  and  +A  Families  (4$  Deg  Separating  Polbode, 

0.03,  0.0?  PenJuloaity  on  A  and  B  Axes  Respectively) 
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SECTION  in 


TOKQUINCi  EQUATION 


The  MKSG  has  ihrec  torquing  coils  centered  on  the  x,  y,  and  z  gyro  axes.  The 
equation  defining  tlie  necessary  currents  in  the  three  coils  to  produce  the  desired  torque 
is  developed  in  lief  1  and  repeated  here. 

Equation  (‘2)  defines  polhode  motion  and  the  effect  pr<  duced  by  torquing.  The 
equation  is  in  rotor  coordinates  and  no  the  torque  vector  must  be  fixed  in  the  rotor  and 
orthogonal  to  spin.  In  general,  the  torque  vector  can  make  any  angle  with  rospeet  to 
the  MUM  vector. 

Define  an  orthonormal  vector  triad  (»»,  d ,  v  )  centered  in  the  rotor  but  not  rotating 
with  the  rotor.  '<  is  along  the  rotor  spin  vector,  u  is  rotated  an  angle  0  about  v  from 
the  MUM  vector  at  time  zero,  and  d  is  V  x  or .  The  torque  unit  vector  is  defined 

Q  *  cos  >  d  sin  w^t  (15) 

where  w  is  the  angular  rate  of  the  rotor  with  respect  to  the  o,  (i ,  v  coordinate  frame. 
At  time  zero  the  torque  vector  Is  along  o  and  hence  it  is  angle  0  from  the  MUM  vector. 

Torque  is  generated  by  a  flux  vector  rotating  about  the  torque  vector.  A  rotor 
fixed  orthonormal  vector  triad  is  defined  (V,  Q,  tty)  where 

Qp  -osln  u{)t  ►  Peos  w{Jt  (l(i) 

The  (lux  unit  vector  to  generate  Q  is 

Ft, UK  Yens  (wpt  ♦  $)  -Q  stnfwpt  *$)  (17) 

where  wj-  is  the  frequency  at  which  the  flux  vector  rotates  nlmut  the  torque  vector  undo 
is  tlie  Initial  phase  angle.  They  are  both  completely  arbitrary. 

Eliminating  In  Kq  (17)  gives 

FLUX  *  o^sin  Wj,t  sin  ( w^t  *0)j  -  d^eos  w^t  sin  (w^t  -  0)j 

*  Y^cos  (w^.t  *0)j  (Ik) 

which  is  a  valid  torque  equation.  The  computer  supplies  vectors©,  d .  Y  to  the  torquing 
electronics  which  then  generate  the  three  components  of  flux  using  Kq  (Ik).  The 
electronics  mechanisation  can  be  simplified  if 

“ l ) 

♦  *  0.  (19) 

which  gives 

FLUX  •»  o  1/2  (1  -  cos  2  w()l )  -  0(1/2  sin  2  w^l)  »  Yeoa  w0l  (20) 

Equation  (20)  is  actually  mechanized  in  the  electronics. 
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Notice  that  a,  p  vectors  supplied  by  the  computer  are  the  normalized  MUM 
demodulator  outputs  rotated  an  angle  0. 


0 

°Mt! 

os  0  i 

P^j  sill  0 

p 

“°M 

sin  b 

•  |3  ^  cos  0 

°M 

*  Pm 

(21) 

°M’  ^M  demodulator  output  vectors  normalized  to  unit  length.  MUM 

vector ‘rotation  caused  by  electrostatic  suspension  foi'cing  at  rotor  frequency  and 
by  phase  shifts  in  MUM  pickoff  electronics  is  compensated  by  adding  a  fixed  bias 
to  angle  0. 
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SECTION  IV 


CONTROL  LAWS 


The  control  law  specifies  the  torque  vector  that  Is  normal  to  the  untorqued 
trajectory.  It  must  specify  torque  to  cross  the  separating  polhode  on  the  desired 
direction  and  it  must  provide  terminal  control  to  place  the  spin  vector  on  the  A  axis. 
Separate  control  laws  are  used  f«m*  ouch  purpose.  The  control  laws  are  described 
in  terms  of  their  location  relative  to  a  unit  vector  along  MUM,  lMUM*  and  a  quadra¬ 
ture  unit  vector,  ImUM  Q.  The  C  and  A  family  control  laws  can  be  readily  deduced 
by  referring  to  tho  plot  of  MUM  direction  la  Figure  5. 

The  +C  family  control  law  is 

Torque  direction  =  -1^^ 

The  -C  family  control  law  is 

Torque  direction  - 

The  A  family  control  law  is 

Torque  direction  ImUM  cos  6  H^uM  Q  sIn6 

where  e  Is  the  polhode  phase  which  is  zero  on  the  C  to  A  and  -C  to  -A  great  oircle 
segments.  Notice  that  this  control  lew  works  for  both  ►A  and  -A  families.  The 
torque  vectors  point  outward  In  the  and  -A  families  and  inward  to  the  w\  family. 

A  special  control  law  Is  required  to  crass  the  separating  polhode  on  the  +A 
family  side.  The  transition. region  Is  defined  as  a  band  on  either  side  of  tho 
separating  polhode  that  is  wide  enough  so  that  the  separating  polhode  cannot  bo 
crossed  in  half  a  polhode  period  starting  from  an  edge  of  tho  transition  region  and 
applying  either  tho  A  or  C  control  laws,  . 

Tho  transition  control  law  must  work  in  both  the  C  and  A  families  since  the 
exact  crossing  point  Is  unknown  and  the  A  or  C  family  can  only  be  Identified  after  a 
complete  cycle  In  that  family.  Furthermore,  tho  control  law  should  make  the 
transition  from  C  to  +A  family  and  not  enter  the  -A  family.  A  simple  solution  is 
to  apply  tho  sum  of  Urn  A  and  C  family  control  laws.  The  C  family  control  law  pro¬ 
duces  no  net  change  In  polhode  latitude  In  the  A  family  imd  vice  versa.  Tho  transition 
control  law  is 

TorfliwDlreoUon  ■■  1MUM  (-Sa&£=iU>)  (22) 

where  the  +  sign  is  taken  for  the  +  transition  and  the  -  sign  for  the  -  transition. 
Equation  (22)  la  not  a  unit  vector  and  must  be  normalized.  Tim  torque  magnitude 
Is  zero  on  the  half  polhode  period  for  which  the  term  in  Eq  (22)  (cos  0  -  (*l)  ts 
less  than  1.  Figure  12  shows  the  torque  direction  for  the  +  transition  control  taw 
about  trajectories  in  the  tA  and  ±C  families.  The  ^transition  control  law  can  also 
be  used  to  cross  from  the  -A  family  Into  the  -C  family  or  with  a  180  deg  reversal  of 
0  in  Eq  (22)  it  eon  bo  used  to  cross  from  the  +A  into  the  -C  family. 
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Figure  12.  +Transltlon  Conti'ol  Law  Torque  Vectors  (08  “  45  dog. 

*  2. 83  sec) 


The  direction  of  the  Ml’M  vector  changos  radically  in  a  small  neighborhood 
about  the  ±C  axes.  Figure  13  shows  the  MUM  vector  on  trajectories  in  a  neighborhood 
of  the  +C  axis.  The  point  at  which  an  extension  of  the  pendulostty  vector  would  Inter¬ 
sect  the  surface  of  tho  sphere  is  shown  which  Is  the  point  of  zero  Ml’M  magnitude. 

In  this  neighborhood  it  ts  very  difficult  to  tell  whether  or  not  the  trajectory  encloses 
the  zero  MUM  magnitude  point.  A  simple  control  law  in  this  region  is  to  only  apply 
the  C  family  control  law  over  approximately  half  the  polhode  period  eon  tor  od  on  the 
high  max  MUM  magnitude  point. 

The  terminal  control  law  in  the  neighborhood  of  the  +A  axis  ts  the  same  ns  tho 
A  faintly  control  law  except  proportional  control  is  used  by  varying  the  time  interval 
that  torque  is  applied. 

The  rate  of  change  of  torque  magnitude  is  limited  in  the  current  mechanization, 
This  feature  now  appears  unnecessary  as  step  (unctions  in  the  flux  field  cause  no  111 
offsets. 

Hie  A  and  C  family  control  laws  are  attempting  to  approximate  the  normal 
control  law.  The  torque  direction  for  the  normal  control  law  is  normal  to  the 
untorqued  trajectory,  ftte  efficiency  of  the  normal  control  law  will  be  computed 
for  small  torques. 
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B-C  PLANK 


Figure  13.  MUM  Vectors  In  tho  Neighborhood  of  the  +C  Axis 
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The  torque  vector,  Tq,  will  be  defined  in  units  of  precession  rate  as 


T  -i- 
Q  wO 


VA 

(?l/B 

Lqc/c  J 


(23) 


where  (.J  ,  Q^)  is  the  physical  torque  vector  defined  in  Eq  (2)  and  u>o  is  the 

magnitude  of  rotor  angular  rate  when  in  the  A-C  plane.  The  change  in  polhode  latitude 
introduced  by  a  unit  torque  impulse  at  time  t  is 


Torque  Efficiency  =  — w  (24) 

3  u) 

where  0  is  polhode  latitude.  This  function  is  a  measure  of  torquing  efficiency  vs 
polhode  phase  and  latitude.  The  function  is  plotted  in  Figure  14  vs  polhode  phase  for 
several  polhode  latitudes.  The  average  torquing  efficiency  is  computed  by  averaging 

l^wover  the  polhode  period  which  will  bo  oallod  w. 


A  similar  computation  can  bo  made  for  tho  A  and  C  control  laws  by  recognizing 
that  only  the  normal  component  of  torque  changes  polhode  latitude.  The  tangential 
component  of  torque  averages  to  zero  over  one  period.  Figure  15  shows  the 
efficiencies  of  the  normal,  A,  and  C  control  laws.  The  C  control  law  is  the  least 
efficient  because  It  is  a  radial  control  law.  Its  efficiency  could  bo  Improved  with  a 
small  second  harmonic  correction  to  tho  torque  direction. 

The  net  efficiency  for  damping  from  C  lo  A  axes  cannot  be  computed  without 
including  a  technique  for  crossing  the  separating  polhode.  An  optimistic  efficiency 
estimate  can  be  obtained  by  simply  computing  the  average  efficiency  for  each  control 
law  which  is 


normal  control  law 

70. 3r; 

A  control  law 

78.  A',‘ 

C  control  law 

75.  &ri 

Therefore  to  damp  from  C  to  A  axes  with  a  4  5  degree  separating  polhode  requlros 
torquing  through  an  angle  of  45  degree/-^  +  11?  deg.  If  torque  is  only 

applied  netu*  the  A-C  great  circle  torquing  efficiency  approaches  100  percent. 
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POLHODE  PHASE  (DEG) 


Figure  14,  Normal  Control  Law  Torque  Efficiency  vs  Polhode  Phase  for 
Several  Polhode  Latitudes  (45  Dug  sepa  rating  Polhode) 


TORQUE 

EFFICIENCY 


Figure  15.  Average  Torque  Efficiency  vs  Polhode  Latitude 


SECTION  V 


AUTOMATIC  DAMPING 


A  block  diagram  of  the  hardware  used  for  automatic  damping  in  the  N57A 
navigator  is  shown  in  Figure  1(5.  The  Ml’M  demodulator  supplies  the  MUM  data  o, 

(5  to  the  computer  in  the  form  of  6  digital  words.  In  the  N57A  navigator  frequency  for 
the  demodulator  is  supplied  by  the  computer.  In  the  tests  reported  here  the  frequency 
was  supplied  by  a  phase  locked  loop  within  the  MUM  demodulator.  In  either  ease  the 
same  frequency  is  supplied  to  the  spin  motor  control  electronics.  Nine  digital  words 
in  the  form  of  three  vectors  o  s=  Ps>  "Y  S  command  the  torque  from  the  computer.  The 
current  in  the  motor  coils,  vector  1^,  is  given  by  the  equation  at  the  bottom  of  the 
figure  which  is  the  one  derived  in  Section  ill. 

The  general  description  of  the  automatic  damping  program  is  presented  hero. 

An  indepth  description  of  the  automatic  damping  program  is  presented  in  Appendices  C 
and  I).  The  logic  is  laid  out  as  much  as  possible  to  allow  very  large  tolerances  on  the 
automatic  damping  parameters.  The  nominal  gyro  and  system  parameters  will  be 
used  to  determine  the  automatic  damping  parameters.  Variations  from  nominal  of 
.MO  percent  or  greater  can  be  tolerated  without  changing  the  damping  parameters. 

The  method  of  determining  the  automatic  damping  parameters  Is  described  in 
Paragraph  2  of  Section  VIII. 

The  computer  cycle  time  for  the  automatic  damping  program  was  planned  for 
1/1(5  sec  since  that  is  a  basic  rate  In  the  N57A  navigation  computer.  The  polhodo 
period  of  the  N57A  gyros  near  the  A  axis  Is  -1  sec.  The  polhodo  period  of  the  gyros 
used  hero  is  about  7  to  t)  sec  depending  on  the  temperature.  The  computer  cycle  time 
was  increased  to  o.  1  sec  so  that  the  stune  program  could  be  used  here  and  on  the 
N57A  gyros  by  maintaining  a  relatively  constant  number  of  computer  cycles  per  A  axis 
pot  bode  period. 

Automatic  damping  problem  will  be  divided  into  two  subproblems,  estimation 
and  control.  The  estimation  problem  must  identify  and  track  the  polhodo  parameters 
needed  for  the  control  laws.  The  control  laws  must  specify  the  direction  and  magni¬ 
tude  of  torque  to  efficiently  damp  the  rotor.  Minimum  polhodo  information  required 
for  control  is  polhodo  phase,  family  identification,  and  special  regions  within  the 
families.  Poliiode  phase  relative  to  otto  polhodo  period  must  be  tracked  continuously, 
Polhodo  phase  is  the  basin  Information  used  by  the  control  law  to  rotate  the  torque 
vector  to  the  desired  dtreetton.  Polhodo  phase  implicitly  identifies  the  +A  and  -A  axes, 
if  phase  lock  ts  lost  (phase  error  greater  than  00  deg)  the  control  will  actually  undamp 
the  rotor.  Therefore,  polhode  phase  tracking  appears  to  be  one  of  the  most  critical 
aspects  of  the  problem.  The  control  strategics  in  the  A  and  C  families  are  completely 
different.  A  special  control  strategy  ts  required  in  crossing  the  separating  polhodo 
to  be  assured  of  always  entering  the  *A  family.  Finally,  a  terminal  strategy  is 
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Figure  16.  System  Block  Diagram 


required  to  complete  the  damping  on  the  +A  axis.  The  overall  organization  of  the 
computer  program  is  shown  in  Figure  17. 

1.  ESTIMATION 

Estimation  can  be  reduced  to  two  subprobloms,  phase  tracking  and  family 
identification. 

a.  Phase  Tracking 

The  polhode  phase  parameter  as  used  hero  is  loosely  defined  with  the  following 
properties: 

1.  Phase  has  360 -deg  monotonic  increasing  variation  within  one  polhode 
period. 

2.  Phase  is  equal  to  multiples  of  90  dog  at  quadrature  points  in  polhode 
trajectory  (intersections  with  A-B,  B-C,  or  C-A  planes). 

3.  Zero  phase  is  at  the  intersection  of  either  great  circle  segment  -A  to 
+C  or  +A  to  -C. 

The  phase  variable  defined  here  is  solely  related  to  the  polhode  pattern.  Phase 
tracking  must  be  based  on  MUM  magnitude  information.  In  most  cases  MUM  magni¬ 
tude  has  a  strong  component  of  second  harmonic  cosine  of  the  phase  variable.  How¬ 
ever,  due  to  pendulostty  components  along  A  and  B  axes  the  phase  of  the  MUM  magni¬ 
tude  signal  is  shifted  a  small  amount  relative  to  the  polhode  pattern. 

The  ultimate  use  of  the  phaso  varlnblo  is  to  direct  the  torque  vector  as  described 
in  Section  III  and  Eq  (21).  The  Ideal  phase  variable  in  the  A  family  is  the  angle  between 
tho  MUM  vector  and  Urn  unit  vector  normal  to  tbo  unforced  polhodo  trajectory  assum¬ 
ing  the  normal  control  law  is  desired. 

The  second  harmonic  component  of  MUM  magnitude  loaves  a  180-deg  uncertainty 
in  the  phase  variables.  This  eon  only  be  resolved  by  recognizing  tho  pendulostty 
components  on  either  the  A  or  B  axes.  The  pendulostty  component  on  the  A  axis 
produces  high  and  low  minima  or  a  fundamental  cosine  component  of  MUM  magnitude 
In  both  the  A  and  C  families.  The  pendul09ity  component  on  tho  B  axis  produces  high 
and  low  maxima  or  a  fundamental  sine  component  of  MUM  magnitude  only  in  the  C 
family.  The  A  family  maxima  are  always  unity'  except  in  a  small  neighborhood  about 
the  -A  axis.  A  pendulostty1  component  on  the  B  axis  does  produce  relatively  subtle 
ckangos  in  MUM  magnitude  waveform  between  the  +A  and  -A  families. 

The  180  deg  uncertainty*  in  the  phase  variable  is  directly  related  to  identification 
of  the  +A  axis.  Since  the  mass  center  is  located  along  -C  and  tipped  4  deg  towards  -B, 
the  +A  axis  is  implicitly  defined  tn  a  right  hand  coordinate  frame.  Tabic  1  relates  the 
MUM  magnitude  maxima  to  the  B  axis  and  the  value  of  the  phase  variable. 
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Figure  17.  Automatic  Polhode  Damping  block  Diagram 
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Table  1.  Sign  Convention 


+C 

-C 

A 

Family 

Family 

Family 

Closest  Approach 

Low  Max 

High  Max 

Max 

to  +B  Axis 

Phase  Variable 

Phase  Variable 

Phase  Variable 

o 

o 

o 

II 

=  90° 

=  90° 

Closest  Approach 
to  -B  Axis 

High  Max 

Low  Max 

Max 

Phase  Variable 

Phase  Variable 

Phase  Variable 

=  270° 

=  270° 

=  270° 

Three  approaches  for  maintaining  phase  lock  will  bo  described.  The  techniques 
will  be  called  simulation,  Fourier  analysis,  and  max/min  tracking. 

(1)  Simulation  Mechanization 

The  simulation  technique  involves  integration  of  Uie  differential  equations  of 
polhode  motion  defined  by  Eq  (2).  This  npproach  would  clearly  yield  tho  most  precise 
tracking  of  the  polhode  motion  if  all  parameters  were  well  definod.  There  are  many 
difficulties  that  moke  this  approach  appear  to  be  the  most  impractical  of  the  three. 

The  initial  conditions  of  tho  differential  equation  must  be  specified  which 
requires  initial  phase  and  polhode  latitude  while  the  initial  statement  of  the  estimation 
problem  only  requires  phase.  The  approach  requires  oil  polhode  parameters  including 
torquing  parameters  to  be  precisely  known  for  use  In  the  differential  equation.  Finally, 
a  closed  loop  control  based  on  MUM  magnitude  must  be  generated  to  keep  the  differ¬ 
ential  equation  solution  synchronized  with  the  real  world  polhode  motion  both  in  phase 
and  latitude,  litis  approach  was  dismissed  on  the  basis  that  simpler  solutions  exist. 

(2)  Fourier  Analysis  Mechanization 

The  polhode  phase  variable  is  based  on  a  constant  frequency  per  polhode  period. 
Sine  and  cosine  of  polhode  phase  are  generated  and  the  first  and  second  harmonic 
Fourier  coefficients  of  MUM  magnitude  are  computed  from  the  sinusoids.  A  sampled 
data  phase  locked  loop  is  constructed  to  maintain  polhode  phase  lock  by  nulling  second 
harmontc  sine  Fourier  coefficient.  The  180-deg  phase  uncertainty  is  resolved  by 
requiring  the  first  harmonic  cosine  Fourier  coefficient  to  be  positive. 

This  approach  has  been  simulated  as  reported  In  Appendix  B.  The  primary 
difficulty  was  caused  by  the  frequency  uncertainty  and  the  large  changes  In  frequency 
from  one  polhode  period  to  tho  next  when  torquing.  Polhode  frequency  is  zero  on  the 
separating  polhode  due  to  the  singularity  on  the  B  axis.  Pltnse  lock  could  not  be 
reliably  maintained  while  crossing  the  separating  polhode  and  therefore  the  technique 
was  discarded. 


(3)  Max/Min  Mechanization 


The  singularity  on  the  B  axis  can  best  be  understood  by  looking  at  the  time 
history  of  MUM  magnitude  as  shown  in  Figure  18  for  polhode  latitudes  46  deg, 

45. 1  deg,  and  45  deg  with  pendulosity  components  of  1  percent  on  -A  and  -B  axes. 

The  singularity  problem  is  simply  that  MUM  magnitude  can  hang  up  near  its  maxi¬ 
mum  value  for  an  arbitrarily  long  period  of  time.  A  mechanization  working  In  the 
time  domain  can  easily  recognize  this.  The  obvious  characteristics  of  MUM  magni¬ 
tude  in  the  time  domain  are  Us  local  maxima  and  minima  points.  The  maxima  and 
minima  occur  at  polhode  quadrature  points  when  pendulosity  is  along  -C. 

The  basic  operation  consists  of  continuously  tracking  maxima  and  minima. 

When  a  maxima  or  minima  occurs  the  phase  variable  is  reset  to  the  next  quadrature 
point  (0  or  180  dog  at  min  events  and  90  or  270  deg  at  max  events).  The  phase  vari¬ 
able  is  not  allowed  to  cross  a  quadrature  point  until  a  maxima  or  minima  occurs. 
Between  max/mln  evonta  the  phase  voidable  is  extrapolated  at  constant  frequency 
based  on  time  between  three  minima  except  special  conditions  apply  after  a  max  ovent. 
After  a  max  event  the  phase  variable  is  frozen  at  tho  quadrature  value  until  the  MUM 
magnitude  drops  a  prescribed  amount  such  as  5  percent  of  its  previous  penk-to-peak 
value.  It  is  then  extrapolated. 


Figure  18.  MUM  Magnitude  Time  Histories  Over  One  Polhode 
Period  (09  •  45  deg,  TA  *  2. 83  see) 
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The  180-deg  phase  uncertainty  is  resolved  by  observing  the  values  of  three 
successive  maxima.  If  the  slope  of  a  straight  line  between  maxima  1  and  2  is  Sj  and 
the  slope  of  a  straight  line  between  maxima  2  and  3  is  S2  then  maxima  3  is: 

1.  High  max  if  S2  >  Sj  and 

2.  Low  max  if  Sj  >  S2. 

The  phase  variable  is  related  to  die  high  and  low  max  as  indicated  in  Table  1. 

Hie  mechanization  is  inherently  stable  even  if  the  phase  variable  extrapolation 
has  large  errors  unless  a  false  min  and  max  are  obtained  which  produces  a  1 80 -deg 
phase  error.  The  high/low  min  or  max  is  tracked  even  during  torqulng  so  the  phase 
error  will  be  recognized  and  the  problem  restarted  if  it  occurs.  Noise  on  the  MUM 
signal  is  the  most  likely  cause  of  problem.  The  max/min  recognition  algorithm  must 
employ  smoothing.  Also  reasonableness  tests  can  be  applied  to  the  max/min  events. 

The  time  of  the  event  ami  MUM  amplitude  of  the  event  can  be  predicted  from  past 
history  to  verify  reasonableness. 

The  max/min  phase  tracking  mechanization  is  used  in  the  automatic  damping 
mechanization. 

b.  Family  identification 

it  is  necessary  to  identify  which  of  several  regions  of  the  sphere  contain  the 
poll urie  trajectory.  The  region  identified  determines  mode  switching  in  the  phase 
tracking  and  control  routines.  Complete  information  is  contained  m  polhode  latitude 
for  longitude  of  0  or  ISO  deg.  However,  less  detailed  information  is  sutficiem.  First, 
three  families  must  be  distinguished:  A  families,  *C  family,  and  «C  family.  The 
*A  families  are  not  explicitly  distinguished.  Two  additional  regions  called  *  transition 
regions  are  small  bands  about  the  separating  polhode.  The  band  in  the  c  families 
must  be  at  least  as  wide  as  the  area  swept  out  by  torqulng  for  one  polhode  pert  ml. 

Small  regions  about  the  A  and  C  axes  must  he  identified  for  estimation  since  die  MUM 
magnitude  may  have  only  one  min  and  max  per  polhode  period.  The  MUM  magnitude 
signal  may  shift  as  much  as  do  deg  relative  to  the  ttolhode  period  near  the  C  axis  for 
it  pendulosity  much  greater  than  A  pendulosity*  A  small  region  about  the  *A  family 
must  be  identified  for  terminal  control  law. 

The  nature  of  MUM  magnitude  in  each  of  these  regions  can  Ik?  seen  in  the  curves  of 
Figures  2,  b,  9,  and  10. 1  it  use  tracking  extracts  the  max  and  min  vahtes  from  MUM 
magnitude  plus  the  peak-to-peuk  value,  the  difference  between  high  ami  low  max. 

Am  ax,  and  the  siojtos  of  the  max  and  min  for  use  in  identification. 

In  the  C  family  die  max  is  less  than  its  largest  possible value,  the  max  has  a 
sloj>e  with  rest  ted  to  latitude,  and  the  two  max  are  not  equal,  tn  the  A  family  die  max 
has  its  largest  (tossible  value,  the  max  is  constant  with  respect  to  latitude,  and  the 
two  max  are  equal.  In  the  transition  zone  Ute  polhode  period  is  long,  the  penh-to-poak 
value  is  large  and  the  max  is  near  Us  largest  value,  in  the  ANlthd  the  conditions  of 
the  A  family  arc  satisfied  and  the  i>eak-to-peak  value  is  small,  in  Ute  CXhlid  the 
conditions  for  the  C  family  are  satisfied  and  the  min  is  small.  Alan  in  Ute  CXIdut  the 
max  and  min  sIojk*  with  latitude  are  of  op|>u*Uc  sign  as  shown  in  Figure  S. 


Several  special  cases  must  be  checked  to  complete  identification. 

Near  the  A  and  C  axes  only  one  min  occurs  per  polhode  period  while  elsewhere 
there  are  always  two  min.  The  transition  between  one  and  two  min  must  be  recognized 
to  avoid  a  180  deg  phase  tracking  error. 

The  sign  of  the  ±C  and  ±  transition  regions  cannot  be  distinguished  by  static 
observations  of  MUM  magnitude  unless  each  gyro's  axial  mass  unbalance  is  individu¬ 
ally  calibrated.  The  simplest  strategy  is  to  apply  the  control  law  with  an  assumed 
sign.  If  the  assumption  is  wrong  the  MUM  magnitude  will  decreaso. 

The  180  deg  uncertainty  of  the  phase  variable  must  be  resolved  in  the  C  family 
as  indicated  in  Table  1. 

If  the  180  deg  phase  variable  uncertainty  is  not  resolved  and  polhode  motion  is 
in  the  A  family,  the  spin  vector  must  be  torquod  out  of  the  A  family  by  reversing  die 
phase  variable  to  malm  the  min  values  have  a  negative  slope. 

When  torquing  out  of  the  A  family  the  torquing  must  be  stopped  after  the  C  family 
is  entered.  The  180  deg  phase  variable  uncertainty  is  resolved  and  then  the  spin 
vector  is  torqued  back  into  the  A  family. 

Terminal  control  in  the  ANbhd  requires  a  number  of  special  identification 
functions.  The  control  angle  or  estimated  colatitudo  must  be  computed  as  a  function 
of  the  peak-to-peak  MUM.  The  damping  complete  decision  must, be  made.  The  MUM 
magnitude  signal  is  heavily  filtered  in  the  ANbhd  because  of  'he  very  smalt  peak-to¬ 
pe  ak  amplitude  signal  in  this  region.  Filtering  is  changed  to  match  die  number  of 
minima  per  polhode  period.  MUM  magnitude  average  slope  due  to  rotor  speed 
changes  etui  overwhelm  die  peak-to-peak  variations.  The  peak-to-peak  amplitude 
must  be  corrected  for  the  average  slope  and  the  mox/inie  filter  must  remove  the 
average  slope  when  recognizing  max  and  min. 

As  a  safety  precaution  special  logic  prevents  the  spin  vector  from  leaving 
the  ANbhd  after  the  180  deg  phase  variable  uncertainly  is  resolved.  If  through  some 
malfunction  phase  lock  is  lost  and  the  spin  vector  is  being  torqued  away  from  the 
A  axis  the  min  slope  will  be  large  negative.  The  phase  variable  is  changed  by  ISO  deg 
to  bring  the  spin  vector  back  towards  A  axis. 
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SECTION  VI 


AUTOMATIC  DAMPING  SIMULATION 


The  automatic  damping  program  was  developed  and  checked  out  with  a  polhode 
motion  simulator  also  programed  on  the  IBM  1130  computer.  The  simulator  was 
x’elied  on  almost  completely  since  the  hardware  was  only  available  for  a  few  weeks  at 
the  end  of  the  project. 

Two  simulation  results  are  presented  here  representing  two  of  the  extreme 
conditions.  The  simulated  gyro  has  45  deg  separating  polhode,  2.  83  sec  polhode 
period  near  the  A  and  C  axis,  and  one  percent  pendulosity  components  along  -B  and 
-A  axis.  The  maximum  torquing  rate  is  0. 123  rad/sec. 

The  first  simulation  is  shown  in  Figure  19  for  the  initial  spin  vector  1.  0  deg 
from  the  +C  axis.  An  enlarged  projection  of  a  5  deg  region  about  the+C  axis  is  pre¬ 
sented  in  Figure  20  to  more  clearly  show  the  initial  trajectory.  An  enlarged  projection 
of  a  5  deg  region  about  the  +A  axis  is  presented  in  Figure  21  to  more  clearly  show  the 
final  trajectory.  The  initial  C  family  sign  is  wrong  and  is  reversed  on  the  second 
identification.  Torquing  is  continuously  applied  thereafter  until  the  transition  zone  is 
entered.  Since  the  MUM  magnitude  slope  was  so  large  some  minima  were  missed  and 
the  +A.  axis  was  not  yet  identified.  Torquing  stops  for  one  polhode  period  after  enter¬ 
ing  the  transition  zone  while  the  +A  axis  is  identified.  This  feature  is  no  longer 
required  and  not  now  programed.  Torquing  resumes  through  the  transition  zone. 

After  3  maxima  on  the  A  family  side  of  the  transition  zone,  SMAX  is  zero  and  A  family 
control  is  now  used.  When  the  ANblul  is  entered  control  is  applied  until  the  desired 
control  angle,  NANG,  is  achieved.  The  sudden  changes  in  trajectory  direction  shown 
in  Figure  21  make  it  easy  to  see  the  times  at  which  torque  is  applied.  Table  2  lists 
the  major  events  during  simulation  and  their  time  of  occurrence.  The  damping  was 
completed  in  67. 8  sec  with  the  spin  vector  0. 02  mrad  from  the  +A  axis. 

The  second  simulation  is  shown  in  Figui'o  22  for  the  initial  spin  vector  3  deg  from 
the  -A  axis.  An  enlarged  projection  of  a  5  deg  region  about  the  -A  axis  is  presented  in 
Figuxe  23  to  more  clearly  show  the  initial  trajectory.  An  enlarged  projection  of  a 
0. 5  deg  region  about  the  +A  axis  is  presented  in  Figure  24  to  more  dearly  show  the 
final  trajectory.  The  initial  polhode  phase  was  wrong  by  180  dog  causing  the  initial 
torque  to  move  the  spin  vector  towards  the  -  A  axis.  The  pliaso  is  automatically  cor¬ 
rected  by  the  "pig  tall”  motion  shown  in  Figure  23  and  torquing  moves  the  spin  vector 
into  the  +C  family.  After  3  maxima  on  the  C  family  side  of  the  transition  zone,  torqu¬ 
ing  is  stopped  for  one  polhode  period  while  the  +A  axis  is  identified.  Torquing  is 
resumed  moving  the  spin  vector  into  the  +A  family.  From  this  point  all  events  are 
similar  to  the  first  simulation.  Table  3  lists  the  major  events  during  simulation  and 
their  time  of  occurrence.  The  damping  was  completed  in  71.  7  sec  with  the  spin  vector 
0. 012  mrad  from  the  +A  axis 

The  torquing  rate  used  here  is  near  the  maximum  allowable  rate  since  it  intro¬ 
duces  such  a  steep  slope  in  MUM  magnitude  near  the  C  axis  that  the  min  and  max 
cannot  be  recognized.  The  maximum  allowable  torquing  rate  appears  to  be  near 
20  dog/polhode  period.  As  shown  in  Tables  2  and  3  major  portion  of  the  time  is  spent 
in  ANbhd  control.  The  time  spent  in  ANbhd  is  not  torque  limited  since  control  is  not 


Figure  19.  Automatic  Polhode  Damping  Starting  1  Deg  Away  From  +C  Axis 
(45  Deg  separating  polhodo,  1  percent  penduioslty  on  A  and  B, 

2. 83  sec  ANbhd  polhode  period,  0. 123  rad/sec  max  torquo) 


Figure  20.  Initial  Trajectory  of  Automata  Polhode  Damping 
Starting  1  Deg  Away  From  +C  Vxis 


Figure  21.  Final  Trajectory  of  Automatic  Polhode  Damping 
Starting  1  Deg  Away  From  -KJ  Axis 


Figure  22,  Automatic  Polhode  Damping  Starting  3  Deg  Away  From  -A  Axis 
(45  deg  separating  polhode,  1  percent  pendulosity  on  A  and  B, 

2. 83  see  ANbhd  polhode  period,  0. 123  rad/sec  max  torque) 


Table  2.  Table  of  Events  During  Automatic  Poihode  Damping  Starting  1  Deg  Away  From  +C  Axis 


B  AXIS  (DEG) 


6. 


Figure  23,  Initial  Trajectory  of  Automatic  Polhode  Damping  Starting 
3  Deg  Away  From  -A  Axis 


Figure  24.  Final  Trajectory  of  Automatic  Polhode  Damping  Starting 
3  Deg  Away  From  -A  Axis 


35 


71.  7  I  19*  5  5  ANbhd  Damping  is  complete 


applied  all  of  the  time.  The  proportional  control  gains  could  be  increased  to  reduce 
the  time  required  but  this  would  increase  the  danger  of  instability  and  phase  loss.  If 
the  pendulosity  component  on  the  A  axis,  60,  was  calibrated  for  each  rotor,  a  more 
efficient  ANbhd  control  law  could  be  devised. 


SECTION  VII 


SPIN  MOTOR  CONTROL  ELECTRONICS 


The  function  of  the  Spin  Motor  Control  Electronics  is  to  control  the  inputs  to  the 
motor  coil  windings  of  the  MESG  as  directed  by  the  computer.  A  block  diagram  of 
these  electronics  is  shown  in  Figure  25.  The  Spin  Motor  Control  Electronics  can 
perform  the  following  functions: 

1.  Rotor  Heating 

2.  Rotor  Spin-Up 

3.  Polhode  Motion  Damping  of  the  Rotor 

4.  Rotor  Spin  Axis  Positioning 

5.  Rotor  Braking 

The  electronics  have  the  capability  of  performing  any  control  law  which  may  be 
derived  for  polhode  motion  damping.  These  electronics  have  been  designed  so  that 
two  MESG’s  may  be  controlled  by  a  single  power  amplifier. 

The  Spin  Motor  Control  Electronics  consist  of  three  different  modules: 

1.  Spin  Motor  Controller 

2.  Spin  Motor  Timing 

3.  Spin  Motor  Power  Amplifier 

A  description  of  the  operation  of  each  of  these  modules  is  given  in  the  following 
sections. 

1.  SPIN  MOTOR  CONTROLLER  MODULE 

The  Spin  Motor  Controller  Module  is  a  plastic  laminated  modulo  with  overall 
dimensions  of  4.  3  by  0. 18  in.  The  functional  block  diagram  of  this  module  is  shown 
in  Figure  26,  The  Spin  Motor  Controller  accepts  nine  data  words  from  the  computer 
(Ax,  Ay,  Az,  Bx,  By,  Bz»  Sx,  Sy,  Sz)  and  then  performs  the  operations  described  in 
tho  following  equation: 

F  -  A  (1/2  fl  -  cos  2  t} )  -  B  (1/2  sin  2  t)  +*S  cos  we  t 

where 

F  is  a  3  x  1  vector  representing  the  X,  Y  and  Z  eo  txaumts  of  tho  motor  flux 

A  is  a  3  x  1  vector  representing  tho  X ,  Y  and  Z  components  of  tho  in-phaso 
component  of  tho  MUM  voctor. 


Figure  25.  Functional  Block  Diagram  of  Spin  Motor  Control  Electronics 


w/o  STROBE 


B  is  a  3  x  1  vector  representing  the  X ,  Y  and  Z  components  of  the  quadrature 
component  of  the  MUM  vector 

S  is  a  3  x  1  vector  representing  the  X ,  Y  and  Z  direction  cosines  of  the  MESG 
spin  axis  in  case  coordinates 

w  is  the  MESG  spin  rate 
s 

The  following  damping  function  is  satisfied  by  the  above  equation._The  Heat  and 
Spin-Up  functions  are  aecomplished_by  controlling  the  values. of  the.  A,  B  and  S  vectors. 
The  heat  function  requires  only  the  B  terms  to  be_set,  with  A  and  S  being  set  equal  to 
zero.  The  Spin-Up  function  requires  the  A  and  B  terms  to  be  set  with  the  S  terms  set 
equal  to  zero  and  the  dc  component  of  the  (1-cos  2  wst)  term  removed. 

The  digital  data  words  are  transmitted  from  the  computer  to  the  Spin  Motor 
Controller  sequentially  in  nine  words.  The  order  of  the  digital  data  words  is  as  follows: 

Word  1  Ax  +  3  Control  Bits 

2  Bx 

3  Sx 

4  Ay 

5  By 

(5  Sy 

7  Az 

8  Bz 

3  Sz 

The  Control  Bits 
T3 

Mont  0 

Damp  0 

Gyro  Seleot  1 

2.  SPIN  MOTOR  TIMING  MODULE 

The  Spin  Motor  Timing  Module,  Figure  27,  is  packaged  on  a  fiberglass  printed 
circuit  board  with  dimensions  of  0. 18  by  4.  3  in.  This  module  phase  locks  to  the  gyro 
rotor  frequency  and  generates  all  the  necessary  timing  and  clock  signals  for  the  Spin 
Motor  Controller  module. 


in  Word  1  are  as  follows: 
T  T 

*  o  *  1 


0 

1 

0 


1 

0 

0 


C2  WT 


■e  27. 


3.  SPIN  MOTOR  POWER  AMPLIFIER 


A  block  diagram  of  the  Spin  Motor  Power  Amplifier  is  shown  in  Figure  28. 

Relays  and  logic  have  been  incorporated  into  this  design  so  that  the  power  amplifier 
can  be  used  for  either  of  the  two  MESG’s  as  determined  by  the  state  of  the  Gyro  Select 
Discrete.  The  application  of  one  of  the  Braking  Discretes  (4>i,  4>2>  or  4*3)  results  in  a 
de  current  applied  simultaneously  to  one  MESG  motor  coil  on  each  gyro.  Braking  is 
accomplished  by  sequentially  applying  a  de  current  to  each  of  the  coils  for  6.  5  sec. 

The  amplifier  is  presently  limited  to  1  ampere  maximum  output  current  and  a 
peak  voltage  swing  of  24  volts.  Transistors  are  available,  however,  which  could  be 
used  to  replace  those  presently  being  used  so  that  the  peak  output  voltage  would  be 
about  60  volts.  The  dimensions  of  the  Spin  Moior  Power  Amplifier  are  5. 2?  by  2. 00 
by  G.  00  in. 

4.  HARDWARE  PROBLEMS 

The  MOS/LS1  Serial/Parallel  Multipliers  and  Shift  Rcgister/Addross  used  Cor 
the  digital  multiplication  function  have  presented  problems  due  to  limitation  in  operat¬ 
ing  speed.  The  clock  for  these  devices  must  be  phase  locked  to  the  rotor  speod,  and 
is  therefore  proportional  to  the  rotor  speed.  If  the  rotor  is  damped  at  2500  Hz,  a 
clock  frequency  of  approximately  1  MHz  is  required.  However,  process  changes  when 
manufacturing  these  MOS  devices  has  resulted  in  an  extremely  low  yield  in  the  numlter 
of  devices  which  will  operate  at  this  frequency.  The  majority  of  these  devices  will 
operate  at  a  clock  frequency  less  titan  820  kHz,  which  required  a  proportionate  reduc¬ 
tion  in  speed  at  which  tlte  rotor  is  damped. 

Better  filtering  was  found  to  ite  required  on  the  -5  volt  reference  to  the  MOS 
devices.  A  capacitor  was  added  to  provide  this  filtering. 

In  order  to  assure  that  the  words  from  the  computer  were  loaded  into  the  projtor 
multiplier,  the  word  strobe  was  synched  with  the  wort!  load  command. 

5.  PROPOSED  ELECTRONICS  DESIGN  IMPROVEMENTS 

As  a  result  of  the  studies  and  tests  conducted  on  tips  program,  a  number  of 
hardware  design  improvements  have  been  identified. 

An  improved  mechanization  for  the  Spin  Motor  Controller  and  Spin  Motor  Timing 
Modules  is  shown  in  Figure  29.  The  new  electronics  reduce  the  component  count 
from  159  for  the  existing  system  to  **6  for  the  new  design.  This  very  significant 
reduction  is  accomplished  by  performing  the  nine  multiply  operations  with  switches 
which  are  driven  by  quasi -square  wave  reference  signals.  The  analog  inputs  to  these 
switches  are  tlte  nine  coefficients  from  the  computer  which  are  required  for  spin 
motor  control.  The  output  from  the  switches  are  thee  summed  and  filtered  with  two 
first  order  low  pass  fillers.  The  resulting  waveform  contains  9. 5  percent  distortion 
on  the  fundamental  harmonic  and  3.8  percent  distortion  on  the  second  harmonic,  which 
is  satisfactory  for  polhode  damping.  The  quasi  square  wave  electronics  will  be  capable 
of  operating  at  full  rotor  speed  of  2430  hz. 


Figure  M.  Spin  Motor  Power  Amplifier  Functional  Block  Diagram 


SECTION  VIII 


TEST  RESULTS 


1.  MUM  MAGNITUDE  SIGNAL 

The  observed  MUM  magnitude  signal  behaves  like  the  simulated  MUM  magnitude 
signal  except  for  very  small  signals  near  the  A  axis.  Here  the  A/D  converter  quanti¬ 
zation  and  noise  become  very  significant.  Also  the  rotor  speed  variation  due  to  torqu- 
ing  and  electrostatic  forcing  cause  very  significant  MUM  magnitude  variations  near 
the  A  axis  as  described  in  Appendix  A. 

The  effects  of  A/D  converter  quantization  and  noise  are  controlled  by  sampling 
MUM  data  many  times  and  digitally  filtering  MUM  magnitude  with  a  first  order  filter. 
The  time  constant  of  the  filter  depends  on  the  expected  frequency  content  and  ampli¬ 
tude  of  the  MUM  magnitude  signal.  For  one  min  per  perioa  in  the  ANbhd  tho  time 
constant  is  0. 8  sec,  for  two  min  per  period  in  the  ANbhd  the  time  constant  is  0.4  sec, 
and  otherwise  it  is  .05  sec.  Tho  data  window  size  of  the  max/min  filter  should  be 
approximately  half  the  time  between  minima  for  maximum  noiso  rejection.  The  nor¬ 
mal  window  size  is  1. 7  sec  which  is  adequate  for  two  min  per  period.  However  it  is 
inadequate  for  one  min  per  polhodo  period  in  the  ANbhd.  Therefore  the  max/min 
filter  Is  only  entered  every  other  computational  cycle  when  number  of  minima  is  one 
in  the  ANbhd  to  give  an  effective  window  size  of  3. 4  sec.  Figures  30  and  31  show 
MUM  magnitude  data  filtored  with  a  0. 8  and  0. 05  sec  time  constant  respectively.  The 
rotor  is  very  close  to  the  A  axis  but  is  not  completely  damped,  noth  figures  show  the 
same  polhode  trajectory.  The  triangles  plotted  in  Figure  30  represent  the  computer 
estimates  of  the  max  and  min  points.  Tho  value  of  the  least  significant  bit  of  the  A/D 
converter  is  also  shown  on  Figure  3d 

The  MUM  magnitude  variation  with  rotor  speed  due  to  electrostatic  forcing  can 
be  seen  in  Figure  30.  The  max/min  filter  must  know  the  nverngo  slope  In  order  to 
find  the  max  and  min  with  small  amplitudes.  The  slope  may  change  significantly  when 
torque  Is  applied  so  only  tho  untorqued  slope  should  ho  used  with  the  max/min  filter. 
Figure  32  shows  the  MUM  magnitude  with  torque  pulses  oeeuring  every  other  polhode 
cycle.  Hoth  the  torque  and  forcing  effects  on  MUM  magnitude  can  be  seen. 

The  peak-to-peak  amplitude  is  used  for  proportional  control  in  the  ANbhd.  The 
peak-to-peak  amplitude  must  be  corrected  for  slope.  For  the  larger  signals  in  the 
ANbhd  a  smoothed  slope  of  the  maxima  is  used.  This  slope  is  not  adequate  for  small 
amplitude  signals  since  it  is  a  combination  of  torquingnnd  forcing  effects.  For  small 
amplitude  signals  the  peak-to-peak  amplitude  ami  untorqued  slope  are  measured  by 
observing  untorqued  polhode  motion  for  one  complete  cycle  between  each  period  of 
torquing.  This  increases  the  terminal  control  damping  time  by  a  factor  of  two  but  it 
is  absolutely  necessary. 

MUM  magnitude  slope  also  causes  difficulty  in  undamping  from  the  A  axis.  The 
signal  can  become  'lost!'  due  to  tho  large  slr-ijo  caused  b.v  Jerquing  and  min  cannot  lx* 
found.  The  solution  is  to  torque  for  a  maximum  of  one  t  tif  a  polhode  period  between 
minima  in  ANbhd. 
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Figure  31.  Polhode  Motion  Residual  of  Run  2,  Gyro  59 
(Filter  Time  Constant  =  0.  05  sec,  PPF  -  0.  0002) 


Figure  32.  Small  Angle  Recorder  MUM  Magnitude  Plot  with 
Torque  Pulses  Applied  at  the  Arrows 


2.  POLHODE  DAMPING  PARAMETER  DETERMINATION 

Automatic  polhode  damping  primarily  depends  on  16  parameters  that  are 
related  to  hardware  parameters.  The  nominal  value  of  the  hardware  parameters  and 
their  maximum  and  minimum  values  are  required.  No  calibration  of  individual  gyros 
or  electron!- ;s  are  required.  A  range  of  ±10  percent  of  parameter  values  can  be  toler¬ 
ated.  A  lai  |er  range  can  be  toloratcd  on  at  least  some  parameters. 

Only  six  basic  hardware  parameters  ore  required.  They  are; 

1.  maximum  torquing  rate 

2.  maximum  MUM  magnitude 

3.  polhode  period  near  A  axis 

4.  polhode  period  near  C  axis 

3.  net  pluise  shift  on  MUM  signal 

6.  noise  level  on  MUM  magnitude  ns  effects  slope  and  A  max  computations. 

Polhode  parameters  from  Gyro  50  hnve  been  measured.  They  are  given  in 
Table  4.  Pendulosity  on  A  and  B  axes  is  also  given  so  that  the  gyro  can  be  simulated, 

Net  phase  shift  is  measured  by  a  special  mechanization  that  adjustB  the  torque 
direction  in  the  C  family  to  lie  tangent  to  the  trajectory  on  the  average.  This  is  done 
by  closed  loop  control  that  adjusts  torque  direction  to  force  slope  of  minima  to  zero. 


TABLE  4. 


Polhode  Parameters  -  Gyro  59,  V  Series  Rotor 


Parameter 

Value 

Maximum  torquing  rate 

1,25  deg/sec 

Maximum  MUM  magnitude 

.  0,48 

Polhode  period  near  A  axis 

85  computational  cycles 

Polhode  period  near  C  axis 

79  computational  cycles 

Net  phase  shift  of  MUM  signal 

36. 6  deg 

Noise  on  slope  and  Amax 
computations 

See:  EPOS,  EPDMA, 

EPSON,  EPSAN  of  Table  5 

Pendulosity  on  A  axis 

4  percent 

Pendulosity  on  B  axis 

14  percent 

The  net  phase  shift  of  the  MUM  signal  is  the  angle  of  the  final  torque  direction  loss 
90  deg. 


Maximum  torqulng  rate  is  determined  by  applying  C  family  control  lnw  to  the 
gyro  in  the  C  family  and  recording  max,  min  and  the  slopes  of  max  and  min.  A 
simulation  is  performed  to  duplicate  the  results.  The  tnrquing  rate  used  in  the  dupli¬ 
cating  simulation  is  the  same  as  the  torquing  rate  in  the  hardwaro. 

Tho  noise  level  on  Blope  and  Amax  computations  are  bounds  based  on  observing 
actual  automatic  damping  results  and  computations  without  torquing. 

The  10  automatic  damping  parameters  are  listed  in  Table  5.  AMAP  defines 
the  ANbhd  size  and  is  arrived  at  through  simulation  using  the  appropriate  torquing 
rate.  PPF  is  determined  by  the  noise  level  and  A/D  quantization  level  in  the  MUM 
magnitude,  TMAX  is  directly  measured  on  the  gyro  by  applying  C  control  lnw  through 
the  separating  polhode,  By  looking  at  the  data  one  can  determine  which  polhode  period 
the  transition  control  lnw  should  have  been  invoked  to  correctly  cross  the  separating 
polhode.  GPAN2,  which  is  the  terminal  control  gain,  is  defined  by 

GPAN2  =  gain//i  (minimum  torque  angle) 
where  minimum  torque  angle  a  l/8  (,  0022  rad/soc)  (.  1  sec). 

For  gain  »  1/.  80,  GPAN2  is  3000. 

The  average  torque  effeciency  near  A  nsis  is  85  percent.  GPAN2  calculated  for  auto¬ 
matic  damping  tests  was  too  small  by/2  through  a  computational  error.  Tho  gain 
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TABLE  5. 


Automatic  Damping  Parameters  Gyro  59  -  V  Series  Rotor 


Parameter 

Description 

Value 

A  MAX 

GO  -  70  percent  of  max  MUM 

0.34 

A  MAP 

Amplitude  of  peak  to  peak  normalized  MUM  in  ANbhd 

0.015 

PPF 

Amplitude  of  peak  to  peak  normalized  MUM  to 
terminate  damping 

0.0001 

PHASE 

MUM  signal  phase  angle 

3G.G  deg 

EPDS 

Threshold  for  determining  that  max  4  0  or  that  max 
slope  4  0 

.02 

EPDMA 

Threshold  for  determining  that  max  slope  -  0 

.008 

EPSON 

Threshold  for  determining  that  min  slope  in  0  family 
is  negative 

.004 

EPSON 

Threshold  for  determining  that  min  slope  in  A  family 
is  of  wrong  sign 

.002 

TA1 

0. 75  times  polhode  period  near  A  axis  (computational 
cycles) 

04. 

TA2 

1.25  times  polhode  period  near  A  axis 
(computational  cycles) 

100. 

TOl 

0.75  times  polhode  period  near  C  axis 
(computational  cycles) 

59. 

TC2 

1. 25  times  polhode  period  near  C  axis 
(computational  cycles) 

99 

TMAX 

Minimum  polhode  period  in  transition  zone 
(computational  cycles) 

90. 

PTMAX 

Maximum  time  without  a  min  event  (computational 
cycles) 

200. 

GPAN2 

Terminal  control  gain  with  2  min  per  polhode  period 

3050 

MANG 

Maximum  control  angle  (NANG)  for  terminal  control 
on  alternate  polhode  periods. 

80. 

was  then  adjusted  omperlcally  ns  reported  in  paragraph  3,  Section  XIII.  Only  run 
No.  10  has  the  calculated  value  for  GPAN2. 

NANG  is  determined  by  the  effect  torqulng  has  on  MUM  magnitude  through  rotor 
speed  changes.  The  value  is  emperically  determined. 


3.  AUTOMATIC  DAMPING  RESULTS 


The  final  program  modification  was  made  on  May  10,  1973  and  test  data  was 
taken  on  May  11  and  14,  1973.  Two  gyros  were  used  in  the  tests,  gyros  59  and  68. 
Both  gyros  have  V  series  rotors  which  implies  that  the  rotors  were  taken  from  the 
same  extrusion  stock  and  therefore  should  have  similar  polhode  characteristics.  It 
seems  reasonable  that  the  variation  in  polhode  characteristics  of  these  two  gyros 
should  correspond  to  the  variation  in  polhode  characteristics  between  any  two  gyros 
taken  off  the  same  production  line.  Calibration  data  was  taken  from  gyro  59  before 
the  polhode  damping  tests  began  and  the  hardware  parameters  were  estimated  as 
discussed  in  the  previous  section.  Calibration  data  has  never  been  taken  on  gyro  68. 
The  polhode  damping  parameters  arrived  at  for  gyro  59  were  used  on  both  gyros  59 
and  68. 

Two  automatic  damping  parameters  were  changed  during  the  tests  and  are  not 
the  same  on  all  runs.  The  damping  complete  threshold,  PPF,  was  set  at  .  0002  for 
the  first  two  runs  which  was  too  high  and  left  toe  much  residual  polhode  motion.  It 
was  changed  to  .  0001  for  the  last  8  runs.  An  error  of^  was  originally  made  in 
computing  terminal  control  gain  GPAN2.  The  gain  was  obviously  too  small  and  so  it 
was  empirically  adjusted  upwards.  Before  the  tenth  run  the  error  in  computation  was 
discovered  and  the  correct  value  was  used.  The  history  of  GPAN2  adjustments  is: 


RUN 

GPAN2 

l,  2 

2800 

3 

3500 

4,  5,  6 

4200 

7,  8,  9 

3800 

10 

3056 

Even  though  the  gain  was  grossly  misadjusted  on  some  runs  the  damping  was  always 
successfully  completed. 

Table  6  summarizes  the  test  results.  Approximate  MUM  magnitude  plots  aro 
shown  in  Figures  33  through  42  ns  referenced  in  Table  0,  The  plots  were  recorded  by 
the  small  angle  analog  recorder  normally  used  for  manual  polhode  damping  and  is  not 
the  same  data  processed  by  the  computer.  The  MUM  veotor  dotted  onto  a  gyro  fixed 
axis  is  plotted  by  the  small  angle  recorder  so  Earth  rate  is  also  seen  on  the  plots. 

Two  pons  are  used  to  simultaneously  record  MUM  magnitude.  Tho  difference  in  gain 
between  the  two  pens  is  approximately  200.  Recording  speed  was  2  divisions/min. 

Difficulties  were  encountered  on  three  of  the  runs.  In  each  case  the  difficulty 
was  overcome  and  damping  was  successfully  completed.  Run  3  encountered  difficulty 
getting  out  of  the  -CNbhd  and  damped  into  the  C  axis  before  turning  around.  It  was 
caused  by  a  program  logic  error  in  deciding  if  the  trajectory  encloses  the  pondulosity 
veotor.  The  initial  trajectory  of  run  3  did  not  enclose  the  pendulo6ity  vector  however 
a  decision  was  made  that  it  did.  The  program  found  it  mado  an  error,  automatically 
re  star  to<l,  and  eame  out  correctly.  Tho  logio  error  is  now  corrected  in  tho  listing 
given  in  Appendix  D. 

Run  6  had  a  very  large  terminal  control  gain  ns  explained  earlier.  As  a  result 
the  polhode  motion  was  over  controlled  and  phase  loss  resulted.  The  rotor  began  to 
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undamp.  This  was  recognized  and  phase  lock  was  re-established.  The  terminal 
control  gain  was  reduced  by  one  half  and  it  slowly  damped  in.  Because  of  the  phase 
loss  and  reduction  of  terminal  control  gain  the  damping  time  is  very  long. 

Run  7  encountered  a  very  noisy  segment  of  data  during  terminal  control  as  can 
be  seen  in  Figure  39.  The  suspension  electronics  has  a  sampling  rate  of  10  KHz. 
When  the  rotor  frequency  passes  through  2000  hz  aliasing  causes  noise  that  would 
otherwise  be  filtered  to  appear  on  the  MUM  magnitude  data.  Damping  was  completed 
with  no  difficulty. 

It  can  be  seen  that  a  majority  of  the  total  damping  time  is  spent  in  terminal 
control  getting  the  last  few  deg.  Without  the  problems  of  noise  and  rotor  speed  - 
MUM  magnitude  coupling  terminal  control  can  operate  at  least  twice  as  fast.  Termi¬ 
nal  control  time  is  also  directly  related  to  polhode  period  near  the  A  axis.  Notice  as 
the  polhode  period  increases  on  successive  runs  due  to  increased  rotor  temperature 
the  terminal  control  time  generally  increases.  Runs  1  and  9  represent  almost  a  2:1 
increase  in  polhode  period  and  terminal  control  time. 

Plots  of  MUM  magnitude  vs  time  after  damping  was  completed  were  taken  by  the 
computer  for  runs  2,  3,  8,  9,  10  and  shown  in  Figures  30,  43,  44,  45,  and  40.  Runs 
1  and  2  had  a  larger  termination  threshold  and  so  there  is  some  obvious  residual 
polhode  motion  in  Figure  30.  The  other  4  plots  show  almost  no  polhode  residual. 
However  the  small  anglo  recording  of  runs  8  and  9,  Figures  40  and  41,  show  obvious 
polhode  motion  residual.  This  must  either  be  due  to  greater  resolution  in  the  small 
angle  recorder  than  in  the  computer  Interface  or  polhodo  modulation  of  anglo  readout. 
Since  the  small  anglo  recorder  indicates  only  one  component  of  MUM  it  also  responds 
to  apparent  attitude  chango  of  the  spin  vector  with  respect  to  gyro  case.  There  was 
insufficient  time  to  rosolve  this  question. 

The  colatitudo  of  the  residual  polhode  trajectory  can  be  estimated  from  the 
MUM  magnitude  plots  if  the  pendulosity  on  the  A  axis  is  known.  The  relationship 
developed  for  terminal  control  in  Appendix  C  is: 

A0  -  PPn/2  90. 

where  A  0  is  polhode  colatitude,  Gq  is  A  pendulosity,  and  PPN  is  normalized  peak -to  - 
penk  MUM  magnitude.  0q  was  measured  for  gyro  59  and  is  dg  >•  .04.  Rased  on  data 
from  automatic  damping  gyro  68  has  approximately  the  same  value  for  Ca  as  59  has. 
The  following  residual  polhode  eolatitudes  are  estimated  from  Figures  30,  43,  44,  45, 
and  40. 


Run 

Colatitude 

pp 

N 

2 

3.3  mrad 

0.20x10 

3 

1,0  mrad 

0.  13x10 

8 

1.4  mrad 

0. 11x10 

9 

2.3  mrad 

0.  18x10 

10 

0.4  mrad 

0.  03x10 
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The  efficiency  of  the  torquing  can  be  estimated  and  compared  with  the  theoreti¬ 
cal  values  computed  in  Section  IV.  Run  2  has  a  known  starting  point  of  the  A  axis. 

It  was  undamped  through  the  A  family  and  into  the  C  family  possibly  by  15  deg.  It  is 
then  damped  out  of  C  and  up  to  the  terminal  control  region  that  starts  at  about  10  deg 
from  A  axis.  With  these  assumptions  the  net  polhode  latitude  change  up  to  terminal 
control  is  110  deg.  The  time  spent  torquing  was  143.5  sec.  At  a  torquing  rate  of 
1. 25  deg/sec  the  efficiency  is  G1  percent.  This  compares  to  the  theoretical  value  of 
79  percent. 

Before  and  after  each  run  the  gap  between  rotor  and  envelope  was  measured. 

The  change  in  gap  is  an  indication  of  rotor  and  envelope  heating.  The  thermal 
coefficients  of  expansion  of  the  rotor  and  envelope  are  0.  39°F/min  and  0.  7G°F/min 
respectively.  Additional  temperature  measurements  were  made  on  run  10.  Both 
gap  and  motor  coil  temperature  measurements  were  made  before  damping  and  period¬ 
ically  for  an  hour  after  damping.  The  motor  coil  immediately  after  damping  was 
4. 04°F  hotter  than  before  damping.  However  since  no  significant  power  was  applied 
to  the  coils  during  the  last  2.  5  min  the  peak  coil  temperature  is  possible  20°F  hotter 
than  before  damping.  After  damping  the  envelope  cools  down  with  a  20  min  time 
constant,  while  the  rotor  has  an  8  hr  time  constant.  An  hour  after  damping  the  gap 
reduced  another  0. 9p  in  which  is  due  to  electrode  cooling.  The  temperature  changes 
of  the  rotor  and  cavity  can  be  deduced: 

Rotor  heating  =3.3  pin  =  1.3»F 

Electrode  heating  =  0.9  pin  =  0. 7°F 

for  run  10.  Heating  on  other  runs  should  approximately  scale  as  the  ratio  of  the  gap 
changes  listed  in  Table  0. 
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Figure  42.  Small  Angle  Recorder  Plot  of  Run  10,  Gyro  OH 
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Polbode  Motion  Residual  of  Run  8,  Gyro  68 


SECTION  IX 


CONCLUSIONS 


Polhode  motion  has  boon  successfully  damped  ten  times  using  two  different 
gyros.  Spin  vector  orientations  woro  vortical  and  north  which  is  the  normal  damping 
orientations  for  the  N57A  navigation  system.  There  were  no  failures  to  damp.  The 
program's  ability  to  automatically  recover  from  errors  in  damping  and  go  on  to  com¬ 
plete  the  dumping  was  demonstrated.  Automatic  damping  parameters  woro  taken 
from  only  one  of  the  two  gyros.  The  other  gyro  has  never  been  calibrated. 

The  most  Important  design  goal  in  developing  the  automatic  damping  program 
is  that  it  must  successfully  damp  the  rotor  ovory  time.  Program  efficiency  and  speed 
wero  also  considered  but  were  of  .secondary  importance.  Future  effort  to  reduce  the 
logic  and  make  the  program  moro  efficient  would  bo  vovy  fruitful.  The  major  portions 
of  the  mathematical  computations  aro  now  programed  in  assembly  language  using 
fixed  point  arithmetic. 

'I ho  longest  damping  time*  excluding  run  (i  which  is  a  special  case,  is  U.  l  mill, 
t  his  is  damping  from  the  A  axis,  out  to  C,  and  back  to  A  which  is  the  worst  case, 
between  2.5  and  5  min  was  spent  in  terminal  control.  Damping  time  is  directly 
related  to  polhode  juried.  A  reduced  polhode  period  and  a  corresponding  increase  in 
torque  will  reduce  dumping  time  proportionately.  Normalizing  on  the  polhode  period 
near  the  A  axis  gives  maximum  damping  time  of  3<i  polhode  periods  and  terminal 
control  time  of  2(5  polhode  periods.  Additional  torqulng  capability  alone  would  reduce 
the  time.  However,  since  automatic  damping  information  Is  only  obtained  one  or  two 
times  jmr  polhode  {icrlod.  mincing  the  number  of  polhode  periods  to  damp  could 
reduce  the  dumping  efficiency.  The  terminal  control  time  Is  net  limited  by  torqulng 
capability. 

A  fast  reaction  goal  of  the  MICHON  system  Is  to  damp  two  gyros  In  one  minute. 
Several  changes  In  the  current  design  will  be  required  to  meet  this  goat. 

1.  Approximately  30  percent  more  torqulng  capability  per  polhode  period  Is 
required  to  reduce  the  maximum  time  in  damp  into  the  terminal  control 
region  from  ,10  polhode  periods  to  20  polhode  jterioda  or  less.  This  requires 
22  percent  more  current  in  the  motor  coils. 

2.  Fast  damping  can  be  accomplished  by  designing  rotors  with  much  shorter 
polhode  periods.  Polhode  period  near  the  A  axis  of  one  see  or  less  appears 
ideal.  The  position  of  the  separating  polhode  is  also  a  factor  effecting  time. 
Polhode  motion  starting  from  the  A  axis  requires  the  longest  damping  time 
with  a  15  deg  separating  polhode,  Vlte  separating  polhode  latitude  could  be 
increased  so  that  the  damping  time  from  either  c‘  or  A  is  equal.  Unfortu¬ 
nately  this  also  increases  the  polhode  period  near  the  A  axis,  ,  relative 
to  the  polhode  period  near  the  C  axis,  T(;,  ns  shown  in  Kq  (!)>»  has  far 
greater  impact  on  damping  time  than  (he  separating  fsdhode  latitude  has. 
Therefore  separating  polhode  latitude  should  not  lie  increased  unless  TA  is 
made  ns  small  as  practical  (loss  than  t  see). 


When  the  polhc  ie  period  is  increased, the  computer  solution  rate  must  also 
be  increased  proportionally  to  1/64  sec  per  computational  cycle,and  torquing 
capability  must  he  ir*c  reused  to  maintain  a  constant  torque  angle  per  polhode 
period. 

3.  Calibration  of  the  terminal  control  gain  for  each  gyro  will  allow  higher  gaio* 
for  terminal  control  and  consequently  faster  damping.  The  navigation  pro¬ 
gram  already  has  a  large  number  of  angle  readout  and  drift  rate  compensa¬ 
tion  parameters  so  adding  two  more  per  gyro  will  not  be  a  severe  penalty. 

4.  The  damping  should  be  performed  at  full  rotor  speed  which  makes  the 
electrostatic  forcing  at  rotor  frequency  negligible.  This  eliminates  the 
coupling  of  rotor  speed  changes  to  MIM  magnitude  changes  and  terminal 
control  can  be  applied  on  every  polhode  period  instead  of  alternate  polhode 
periods  as  was  done  in  the  tet?ts  reported  here.  The  same  result  can  be 
achieved  by  operating  at  a  low  rotor  frequency  such  as  400  Hz.  However, 
the  polhode  period  is  much  longer  at  400  Hz  rotor  frequency.  The  new 
quasi  square  wave  pin  motor  control  electronics  will  be  capable  of  operating 
at  full  rotor  speed  while  the  current  electronics  were  not. 

Hotor  speed  changes  by  ns  much  ns  114  Hz  occurred  during  damping.  This 
may  be  due  to  motor  coil  axis  misalignment  and  gain  variations, but  it  has 
not  been  investigated.  Linearity  and  tic  offsets  in  the  electronics  were 
measured  amt  do  not  appear  large  enough  to  cause  these  effects,  1‘ncom- 
pen  sated  itngle  readout  errors  as  large  as  one  deg  occur  and  mav  contribute 
to  rotor  speed  errors, 

Hotor  speed  must  he  controlled  to  stay  in  the  notch  for  minimum  electro-static 
suspension  forcing.  The  spin  motor  control  electronics  can  be  periodically 
switched  to  a  rotor  spin  mode  and  the  rotor  speed  adjusted, 

3.  If  two  gyros  arc  in  be  damped  w  1th  the  same  spin  motor  control  electronics 
faster  reaction  Line  can  be  achieved  by  time  sharing  the  electronics  In  the 
terminal  control  mode,  Kaeh  gyro  would  have  to  he  sequentially  brought 
into  the  terminal  com  re!  region.  However  since  Hie  tofqutng  duly  cycle  Is 
verv  low  in  terminal  control  the  electronics  could  be  time  shared  with  little 
loss  of  efficiency. 

Ihc  fastest  damping  lime  can  be  achieved  tsv  using  separate  spin  motor 
control  electronics  for  each  gyro  and  damping  b-.dh  gyros  simultaneously. 

With  the  above  modifications  the  one  minute  a-.^omnUc  damping  requirement  can 
be  budgeted 

Uampc.yro  Xo.  I  up  to  terminal  eaomd  20  sec 

damp  tfyro  No.  2  up  to  terminal  control  20  sec 

.Simultaneously  apply  terminal  room?}  to  No.  1  and  2  10  see 

Whit  U  leaves  a  10  sec  safety  factor.  Motor  current  must  be  Increased  by  a  factor  of 
X  3  which  is  approximately  000  ma ,  one  «mp  is  planned  for  use  In  fast  warmup.  The 
current  requirements  could  be  reduced  if  dual  spin  motor  control  electronics  were  used 
and  both  gyros  damped  simultaneously. 


The  residual  polhode  motion  after  automatic  damping  varied  between  2.3  and 
0, 4  mrad  with  a  termination  threshold  of  0,0001,  The  residual  polhode  motion  is  about 
the  same  or  a  little  worse  than  that  achieved  by  manual  damping.  The  residual  polhode 
motion  appears  adequate  to  meet  the  navigation  requirements.  The  termination 
threshold  is  dependent  on  the  noise  level  in  the  MUM  data. 

Rotor  heating  during  polhode  damping  must  be  anticipated  during  fast  warmup 
so  that  the  rotor  is  not  over  heated.  Fast  rotor  hunting  U. applied  before  spinup  and 
polhode  damping.  Rotor  temperature  is  left  sufficiently  low  so  that  the  rotor  Is  still 
under  temperature  after  failhode  damping.  Rotor  heating  to  achieve  thermal 
stabilization  Is  performed  after  polhode  damping. 


APPENDIX  A 


MUM  SIGNAL  WITH  ELECTROSTATIC  SUSPENSION  FORCING 
AT  ROTOR  FREQUENCY 


The  geometry  of  the  rotor  is  shown  in  Figure  A-l.  Electrostatic  forcing  acts 
on  the  center  of  geometry .  The  vector  force,  Fg,  applied  by  the  suspension  is 

Fg  =  -  G  $>  M  (Al) 

where  G  is  scalar  gain  at  rotor  frequency,  M  is  MUM  vector,  and  $  is  (3  x  3)  matrix 


4>  =  I  cos  +  r^-r  sin  4>  (A2) 

I  ^  I 

4>  is  scalar  phase  shift  of  electrostatic  suspension  at  rotor  frequency,  -  is  rotor 
frequency  and  Z  is  (3  x  3)  skew  sy .me trie  "cross  product"  matrix 


U> 


The  centrifugal  force,  Fa,  is 


O  -  cOy 

U Jrj  0  ~ 

_  -  Wy  O 


(A3) 


FA  =  -M  w2  R  (A4) 

where  M  is  rotor  mass  and  U  is  the  vector  radius  of  the  mass  center  orbit.  Summing 
the  forces 


Fg  +  Fa  ^  -M  w2  (p  +  M)  -  G  $M  =  0 


(AS) 


Solving  for  MUM,  M, 


M  * 


-  2 

u> 


P 


Tliis  can  be  put  in  a  more  convenient  form  b\-  defining  a  quadrature  pendulosity 
vector,  !>q, 


(AG) 


P 


w 

Q  =  "R”  v 


(A7) 
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Figure  A-l.  Motor  Geometry 


and  quadrature  MUM  vector,  M  » 

n 

Mn  ,4r  m 

Q  M 

Equation  (Ad)  can  lie  written 

(l - — ,  eos<j»\  M  -/  —  9  sln<t>\  Mf . 

\  M|w|-  /  \M|wr  /  Q 

Multiplying  Kq  (AO)  byui/|w|  gives 

(±rin1n  1  (l  -  ^  •“« 

Solving  for  M  and  M 
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(All) 


(A  12) 
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2G 


cos  4>. 
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Equations  A11-A13  show  the  electrostatic  forcing  at  rotor  frequency  introduces 
amplification  and  phase  shift  of  the  MUM  single  relative  to  its  zero  forcing  value. 
However  the  amplification  and  phase  shift  is  not  dependent  on  position  of  the  spin 
vector  on  the  rotor.  The  MUM  magnitude  is  now  frequency  dependent  since  forcing 
gain  and  phase  are  frequency  dependent.  The  relative  forcing  gain  as  a  function  of 
rotor  frequency  is  shown  in  Figure  A -2  for  the  N57A. 
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Figure  A -2.  Suspension  Forcing  vs  Kotor  Frequency 


APPENDIX  B 


FOURIER  ANALYSIS  PHASE  TRACKING 


The  polhode  phase  variable  is  based  on  a  constant  frequency  per  polhode  period. 
Sine  and  cosine  of  polhode  phase  are  generated  and  the  first  and  second  harmonic 
Fourier  coefficients  of  MUM  magnitude  are  computed  from  the  sinusoids.  A  sampled 
data  phase  locked  loop  is  constructed  to  maintain  polhode  phase  lock  by  nulling  second 
harmonic  sine  Fourier  coefficient.  The  180-deg  phase  uncertainty  is  resolved  by 
requiring  the  first  harmonic  cosine  Fourier  coefficient  to  be  positive. 

The  MUM  magnitude  sine  and  cosine  first  and  second  harmonic  and  average 
value  are  plotted  vs  polhode  latitude  in  Figures  B-l  through  B-3,  for  0S  -  45  deg  and 
1  percent  pendulosity  vector  along  -A.  Sine  first  and  second  harmonic  are  zero. 

The  same  variables  are  also  plotted  for  1  percent  pendulosity  on  -A  and  10  per¬ 
cent  pendulosity  on  -B  in  Figures  B-4  through  B-8.  All  of  the  curves  have  either  a 
dip  or  peak  at  45  deg  latitude  since  the  frequency  goes  to  zei'o  at  this  latitude.  The 
point  at  45  deg  is  not  plotted  since  it  is  a  singularity  and  the  nearest  point  plotted  is 
0. 5  deg  from  the  singularity. 

Fourier  analysis  sensitivities  to  frequency  errors  and  errors  due  to  not  taking 
an  integer  number  of  samples  per  polhode  period  were  computed.  Considering  the 
dynamic  range  of  the  Fourier  coefficients  it  was  decided  to  compute  the  Fourier 
coefficients  with  a  least  squares  filter  to  avoid  some  of  the  numerical  problems. 

The  five  state  least  squares  filter  used  second  harmonic  sine  and  cosine,  first 
harmonic  cosine,  nverage  value,  and  ramp.  The  ramp  state  was  added  to  describe 
MUM  magnitude  variation  while  torquing.  The  filter  is  initialized  once  per  polhode 
period  at  27u-deg  phase  which  is  near  the  -B  axis. 

A  sampled  data  phase  locked  loop  was  used  to  track  polhode  frequency  and 
maintain  phase  lock.  The  frequency  and  phase  outputs  of  the  phase  locked  loop  are 
used  to  correct  the  sine,  cosine  signals  used  as  the  reference  to  compute  the 
Fourier  coefficients  for  the  next  sample.  The  error  signal,  4>,  to  the  phase  locked 
loop  is 

1  -1  ®2 

T tnn  ('c7)  (B1) 

where  Sg  and  C2  are  the  Fourier  coefficients  of  second  hnrmonic  sine  and  cosine, 
respectively.  A  block  diagram  of  the  phase  locked  loop  is  shown  in  Figure  15-9.  The 
sampling  period  is  T  which  Is  also  the  polhode  period.  The  effective  sampling  time 
is  the  midpoint  of  the  data  collection  interval  since  the  best  fit  criterion  of  least 
squares  mensuros  the  average  phase  error  in  the  presence  of  changing  frequency. 

The  lag  of  half  a  sampling  period  is  introduced  since  the  data  are  not  available  until 
the  end  of  the  data  taking  interval.  Using  modified  Z  transforms  (Ref  2)  system 
response  is  computed. 

Kg  (Z-l)  h$(Z) 

Z2  -Z(2-KrK2T)  (1-Kj) 
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Figure  B-3.  Minus  Second  Harmonic  Cosine  of  MUM  Magnitude  for  Pendulosity 

on  -A  Axis  of  1  Percent  (6S  =  45  deg) 


Figure  B-l,  Average  MUM  Magnitude  for  Pendulosity  on  -A,  -H  Axes 
of  1  and  10  Percent,  Respectively  (0S  =  45  deg) 
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Figure*  R-7.  Minus  Second  Harmonic  Cosine  of  MUM  Magnitude  for  Penduloslty  on  -A 
-H  Axes  of  1  and  10  Percent,  Respectively  (0S  -  45  deg) 
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Figure  11-8.  Minus  Second  Harmonic  Sine  of  MUM  Magnitude  for  Penduloslty  on 
-A,  -Hof  1  nnd  10  Percent,  Respectively  (os  *  45  deg) 
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Figure  n-U,  Phase  Locked  Loop  Block  Diagram 

For  a  time  constant  r  *  T  and  a  damping  ratio  of  U.7,  the  phase  locked  loop  gains 
are 


«  0.8«f) 

Kg  *  0. 7.15/T.  (Bit) 


Polhode  frequency  varies  with  polhode  latitude  ns  shown  in  Figure  2  and  since 
torqulng  changes  polhode  latitude,  it  is  of  interest  to  determine  how  po"  ode  frequency 
varies  with  tor<|Uing  to  determine  whether  or  not  phase  lock  enn  be  maintained.  A 
control  law  must  he  assumed  to  establish  these  relationships.  Therefore,  it  is 
assumed  the  torque  is  always  applied  normal  to  the  trajectory  which  is  the  unit  vector. 


u 


N 


.j.  wXu* 
|u)Xui| 


<m> 


The  torque  vector,  Tq,  will  be  defined  in  units  of  precession  rate  as 


.1 

wl) 


rvA' 

vcJ 


d«) 


H2 


where  (Qa,  Qb>  Qc)  is  physical  torque  vector  defined  in  Eq  (2)  andw0  is  the 
magnitude  of  rotor  angular  rate  when  in  the  A-C  plane.  The  change  in  polhode  latitude 
introduced  by  a  unit  torque  impluse  at  time  t  is 

Torque  Efficiency  =  M  w  (B6) 

dw 


where  8  is  polhode  latitude.  This  function  is  a  measure  of  torquing  efficiency  vs 
polhode  phase  and  latitude.  The  function  is  plotted  in  Figure  16  vs  polhode  phase  for 
several  polhode  latitudes.  The  average  torquing  efficiency  is  computed  by  averaging 

—  w  over  the  polhode  period  which  will  be  called  w.  For  an  infinitesimal  torque, 


acting  over  the  entire  period, 


df> 


T 


1> 


(B7) 


To  obtain  a  quick  answer  for  these  preliminary  relationships,  it  will  be  assumed  that 


VVV1 


(118) 


The  result  of  the  above  approximation  is  that  relationships  will  be  computed  for 
an  ensemble  of  trajectories  with  starting  phase  uniformly  distributed  to,  2  « ) 
instead  of  the  desired  single  trajectory  with  starting  phase  of  zero  degree. 
Equation  07)  can  be  integrated  as 


m 


so  given  a  starling  latitude  8  j.  the  final  latitude,  8.,,  after  one  polhode  period  can 

Ite  computet)  from  the  alxtve  equation.  The  average  frequency  over  the  polhode 
period  can  tie  computed 


v  „ 
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as  well  as  the  average  frequency  over  the  previous  jwlhode  period 
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Figure  IV 10.  Torque  Kiflclcncy 


Figure  11-11  shows  %jj)  plotted  vs  f^t^y  ami  Figure  11- 12  shows  (ftf  t:\V~foiJ)) 
plotted  v%  foyj  assuming  a  torquing  rate  oi  u.01  rad/see  anti  rotor  parameters 
TA  ?  2*  h:i  see  and  08  In  deg. 

If  the  frequency  used  for  phase  tracking  is  only  itnstsl  on  the  measured  frequency 
of  the  previous  polhodc  period,  the  resulting  phase  error  will  be 

Phase  Krror  ■  ( (f^  KW  -  *OLD)/fNtiVV)  l300  deg) 


The  phase  error  is  plotted  in  Figure  if- to,  A  means  of  frequency  prediction 
is  clearly  required.  The  frequency  pretlietion  approach  used  is  to  curve  fit  Fig-* 
ure  U-12.  Two  functions  arc  required  since  the  curve  is  double  valuctl.  The  curve 
fit  was  performed  by  weighted  least  squares  to  yield  lor  the  -A  and  C  families 
(bottom  segment  of  curve) 
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o.cnoi  x  to"1  (o.  i  no  -  fuj 
<f()l (I)-o.iifaHfo.itt??-rot  o.?oi  *  i«“a) 


(1U2) 


aiul  fur  the  *  A  family  (top  segment  of  curve) 
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Figure  IM1.  PoUwkIc  Frequency  (fftKW)  vs  Previous  Polhotte  Frequency  tfoU)) 
for  Torquing  Hate  of  0,01  RntFSee  (0g  &  43  deg,  r  2,  *3  see) 


Figure  11-12,  Change  In  l*olhndc  Frequency  vs  Previous  IMhotk?  Frequency 
(f01  jj)  for  Torquiug  Hale  of  0,01  Kad/Scc  (Gy  -  43  <k’g,  !  2.  S3  sec) 
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Pignr «  lt-15.  Phase  Krror  Without  Frequency  Prediction  for  Torquing 
Hatt>  of  O.Ut  Had/Sce  (0^  «  15  deg,  TA  3.«»  see) 

The  phase  error  using  tin?  curve  fit  frequency  prediction  is  loss  tlian  3  deg.  The 
curve-  fit  could  lie  improved  with  minor  modification. 

At  thin  point  one  should  notice  that  the  Fourier  analysis  mechanisation  is 
evolving  into  a  form  that  has  many  of  the  objections  of  the  simulation  meehnnissntmn. 
The  primary  concern  is  Urn  heavy  dependence  on  rotor  ami  forqsor  parameters  for 
frequency  prediction.  The  sensitivity  to  the  major  parameters  e8,  T  ,  ntsi  mag¬ 
nitude  of  Tty  was  imputed.  The  problem  to  be  analysed  can  tic  stated  as  given 


(0,  V)  -  fN*KW  -  fal>r, 


(mi) 


Find  the  change  in  AP  for  a  change  in  parameter,  P.  for  a  given  value  »f  foi 
The  sensitivity  is 
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and  the  ;>hase  error  sensitivity  is 
Phase  terror  Sensitivity  f 


“jjr1  ddibdeg) 


(IHU) 
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The  computed  phase  sensitivities  are  plotted  in  Figures  B-14  through  B-16  for 
parameters  d6g,  (d  Ta/Ta),  and  (d |Tq|/|Tq!),  respectively  vs  polhode  latitude  at 
the  beginning  of  the  polhode  period.  The  sensitivities  only  predict  phase  error  changes 
for  infinitesimal  parameter  changes.  Because  of  the  large  singularity  at  the  separat¬ 
ing  polhode,  the  results  cannot  be  extended  to  large  parameter  changes  in  this  region. 

The  Fourier  mechanization  with  prediction  was  simulated  in  spite  of  the  sen¬ 
sitivity  results.  The  simulation  used  the  A  fpmily,  ±C  family,  and  transition  control 
laws.  The  only  difficulty  encountered  was  in  crossing  the  separating  polhode.  It  was 
not  possible  to  maintain  phase  lock  if  the  separating  polhode  was  crossed  near  the 
B  axis  which  is  where  the  singularity  exists.  This  is  due  in  part  to  the  assumption 
made  in  computing  the  predicted  frequency  as  stated  by  Eq  (B8).  There  is  also  a 
feedback  coupling  from  control  to  estimation  since  the  frequency  change  over  a  polhode 
period  is  related  to  torquing  efficiency..  Torquing  efficiency  in  turn  is  degraded  if  the 
estimation  mechanization  has  phase  errors.  Under  certain  conditions  this  can  be  a 
positive  feedback  loop. 

The  problems  listed  in  the  above  paragraph  are  not  insurmountable.  However, 
it  is  becoming  clear  that  the  computer  mechanization  will  be  complex  and  this  is 
therefore  an  undesirable  solution.  The  difficulty  is  completely  related  to  the  singu¬ 
larity  on  tlu*  B  axis  and  a  mechanization  ttot  avoids  the  singularity  is  preferable  to 
one  that  attempts  to  compensate,  for it. 


Figure  U-14.  Frequency  Prediction  Phase  Error  Sensitivity  to  Normalized  A 
Axis  Polhode  ikfriod  (Delta  Ta/Tak  M«a  45  deg*  T.  **  2. tut  see. 
Torque  o,  tit  rad/sec)  * 

*7 


Figure  !Mf».  Frequency  Prediction  Phase  Krror  Sensitivity  to  Separating 
Polhode  latitude  (0g  *>  15  deg,  TA  2. HU  sec.  Torque  *  0.0!  rad/ sec) 
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Figure  II- 1«.  Frequency  Prediction  Phase  Krror  Sensitivity  to  Normalized  Torque 
Magnitude  (Delta  Torque/Torque).  (oB  •»  45  deg,  TA  -  2.02  sec, 

Torque  r  0.01  rad/seo) 


APPENDIX  C 


AUTOMATIC  POLHODE  DAMPING  MECHANIZATION 


The  mechanization  described  here  has  been  programmed  in  Fortran  and 
assembly  language  on  the  IBM  1130  computer  and  operated  successfully.  A  listing 
of  Fortran  subroutine  CNTLlt,  is  presented  in  Appendix  D.  The  operation  of  the 
subroutine  directly  corresponds  to  the  discussion  presented  here.  The  subroutine 
is  an  example  of  one  possible  implementation  of  the  mechanization  equations.  All 
of  the  details  of  implementing  automatic  damping  logic  are  presented  in  the  subroutine 
listing.  -The  text  will  concentrate  more  on  the  functional  description  of  the  logic. 


The  principal  variables  used  in  automatic  polhotlc  damping  are  listed  in 
Tal  k*  Cj,  and  the  constants  used  are  listed  in  Table  CIL 


The  automatic  damping  routine  attempts  to  locate  the  spin  vector  on  the  rotor 
so  that  an  appropriate  control  law  can  be  applied.  It  is  only  necessary  to  locate 
the  spin  vector  in  one  of  five  possible  regions  of  the  rotor  and  determine  the  phase 
of  the  polhode  motion.  The  five  regions,  which  do  not  have  sharp  boundaries,  are 

1.  C*  Nblul  -  a  small  region  alxiut  the  *C  axes  that  does  not  enclose  the 
pcndulosily  vector 

2.  C  Family  -  the  central  part  of  the  total  *C  families 

3.  Transition  Zone  -  a  band  about  the  separating  polhode  containing 
both  the  t‘  and  A  families 

4.  A  Family  -  the  central  pin  of  the  total  A  families 
o.  AXbhd  -  u  small  region  alwut  the  *  A  axes 

1.  HEAD  MUM  DATA 


The  MUM  data  is  read  11*0111  the  A/D  converter  exactly  as  is  done  in  the 
navigation  computations.  Two  three  element  vectors,  0  .,  ft..,  are  obtained  for 
each  gyro,  i  1,  2.  Apply  de  offset  correction  mul  compute  y  .  for  the  gyro  being 
damped. 


°ol  °ui "  '  °1U 

'\tr%i 

Vot  *  °oi  s  Pol 
1  *  1  or  2 


(3x1)  vectors 


AOjy,  previously  stored  dc  offset  compensation  vectors. 
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Table*  C-l.  Princijxil  Variables  Used  in  Automatic  Polhodo  Damping 


Variable 

Definition 

AMM 

Current  value  of  MUM  magnitude 

AMPK 

1  .a test  max  or  min  value  of  AMM  found  in  max/min  search 

PEAKX 

1  .a test  max  value  of  AMM 

PEAKN 

Latest  min  value  of  AMM 

PP 

Difference  between  latest  max  and  min  value  of  AMM 

TP 

Latest  observed  polhode  period  (0.  i  see  stops) 

PTNO 

Time  of  occurrence  of  latest  min  value  of  AMM  (0. 1  sec  slops) 

PTO 

Time  of  oeeurrenoe  of  min  tlfSO  dog  back  In  polhode  phase 
from  lutest  min  (0.  L  soo  stops) 

AMNO 

Value  of  min  JM10  deg  back  In  polhode  phase  frotn  latest  min 

AMXO 

Value  of  max  liW)  dog  back  in  polhodo  pint  so  from  latest  max 

AMXI 

Value  of  max  IHO  deg  hack  in  polhodo  phase  from  latest  mux 

UMAX 

Slope  of  max  values 

SMIN 

Slope  of  min  values 

UMAX 

Difference  between  high  and  Jew  max 

NMIN 

Number  of  minima  per  polhode  period 

PE 

Phase  variable  extrapolation  frequency  (rad/step) 

CT.  ST 

Cos,  sin  of  plume  variable 

AMMAX 

Value  of  max  threshold 

CMAX 

Value  of  threshold  for  C  Nbhd  control  law* 

DNANG 

Maximum  Umpting  angle  for  ANbtid  eoatixd  law 

TOHKj,  TOUK-j 

Control  iuw  commands 

SC.N 

Sign  of  C  family  (  >11 

vvK 

NormuUxod  PP  *  PP/PKAKX 

90 


Table  C-l  (Cont) 


Variable 

IFAM 


I  KHZ 


IPIIAS 
fl)MAX 
1SMAX 
IS. MIN 


Description 

Region  of  polhode  motion 

1.  C  Nbhd 

2.  C  Family 

3.  Transition  2onc 

4.  A  Family 

5.  A  Nbhd 

6.  Undefined  Region 

Phase  variable  extrapolation  control 

1.  Kxtrapolate 

2.  Do  not  extrapolute 

3.  Do  not  extrapolate,  check  max  threshold 
Flag  -  1  Indicates  A  axis  has  been  Identified 

Flag  -  1  Indicates  value  of  UMAX  is  valid 
Flag  -  1  indicates  value  of  SMAX  is  valid 
Flag  -  1  indicates  value  of  SMIN  is  valid 


Table  C-2.  Constants  Used  in  Automatic  Polhode  Dumping 


Constant 

TMAX 

TA1 

TA2 

TCI 

Tea 

AM  At* 

AM  AN 

KI*I)S 

KPMK 

KIMttlA 

KP8CN 

KP8AN 

TPO 

<t>‘p 

C1PAN3 

PPP 


Description 

TI*  threshold  for  transition  zone 
TP  threshold  for  NMfN  change  from  1  to  2  in  ANbhd 

TP  threshold  for  NMIN  ehtuige  from  2  to  i  in  ANbhd 

T  l*  threshold  for  NM  IN  change  from  1  to  2  in  C'Nl)hd 

TP  threshold  for  NMIN  change  from  2  to  1  in  CNbhd 

PP  threshold  for  ANbhd  and  CNbhd 
PKAKX  threshold  for  A,  t  family  logio 
‘threshold  for  testing  DVIAN  for  zero 
Threshold  for  testing  SMAX  for  nonzero 
Threshold  for  testing  SM  AX  for  zero 
Threshold  for  testing  SM1N  for  large  positive  value 
Threshold  for  testing  NMIN  for  large  negative  value 
Maximum  period  of  extrapolation  frequency,  1*‘K 
<  hinge  in  phase  variable  from  mux  to  max  threshold 
ANbhd  proportional  control  gain 
PP  threshold  for  damping  termination 


Compute  MUM  magnitude,  AM,  and  normalize  pQi,  vq^. 


m  *  y%\  •  %i +  a*  •  ^oi  V2 


°N  *  °oi 1  v/°oi  *  °oi 
3  ^oi  ^ 

yN  "  Yoi  /  Aoi  *  Yol 


{3x1)  vectors 


i  =  1  or  2 
AM  is  filtered  by 

AMM  «.  AMM  +  <2’P)(AM  -  AMM) 

where  p  is  a  program  variable  with  value  p=l  everywhere  except  the  ANbhd  where  it 
has  values  p=4  or  5.  MUM  data  is  read  four  times  per  computer  cycle  (0, 1  sec). 
AMM  is  tire  sole  piece  of  information  used  for  automatic  damping  estimation,  on* 

^N*  vn  ar0  U4JccJ  in  spin  motor  control  electronics  outputs. 

2.  PHASE  TRACKING 

The  purpose  of  pint  sc  tracking  is  to  maintain  phase  lock  with  the  polhode  motion, 
Ttie  sin  and  cos  of  the  phase  variable  is  computed.  Phase  lock  is  maintained  by 
requiring  the  phase  variable  to  be  at  quadrature  values  at  max  or  min  points  in  MUM 
magnitude.  The  MUM  magnitude  data  is  continuously  examined  for  local  maxima 
and  minima.  Plume  variable  is  extrapolated  between  max  and  min  points  based  on 
previous  observations  of  polhode  period.  Logical  operations  are  performed  to  decide 
whetiict*  to  extrapolate  the  phase  variable,  freeze  it,  or  reinitialize  it. 

a.  Maximum/Minimum  Search 

The  max/mitt  search  is  based  on  a  moving  window  least  squares  filter  using 
17  data  points.  The  data  are  fit  to  a  quadratic  function  In  time 

f(n)  a  A  -211  n  ♦  C  n2 

*  C  (n  -  1VC)2  *  (A  -  li2/0 
-8  s  it  s  8 


where  the  midpoint  of  the  window  is  taken  as  lime  zero.  A  max  or  min  event  occurs 
only  if  the  point  of  zero  slope,  n0,  of  f(n)  falls  in  the  range 

o  <  u0  8  U/C<  8 
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The  point  of  zero  slope  is  allowed  to  move  to  the  leading  edge  of  the  window  so  that 
the  broad  max  as  shown  in  Figures  7  and  18  can  always  be  recognized.  Hie  best 
estimate  of  the  max  or  min  parameters  is  obtained  when  the  point  of  zero  slope  is 
at  the  midpoint  of  the  window  and  so  the  last  recognition  of  the  max  or  min  is  when 
it  is  nearest  the  midpoint.  Usually  a  max  or  min  event  will  be  recognized  on  7  or  8 
successive  cycles. 

The  window  size  should  bo  approximately  half  the  distance  between  min  near  tho 
A  or  C  axis  or  1/4  the  polhode  period,  it  will  be  seen  later  that  a  minor  simplifica¬ 
tion  occurs  if  tho  window  size,  2N+1,  is  such  that  N(2N-l)/3  is  an  integor. 

Sometimes  in  tho  ANblul  an  additive  slope  must  lie  removed  from  the  data 
before  the  max  or  min  can  Ijo  recognized.  The  quadratic  fit  is  performed  on 

AMM  -  (n)  (IS LOP)  -  A  -  (21!  +  1SLOP)  nK’ii2 

whore  IS  LOP  is  the  slope  to  be  removed.  Therefore  a  max  or  min  event  occurs 
only  if 

n  + i8i.o  p/a 


The*  least  squares  computations  for  2N+1  window  size  (N  *  8)  is 

IH  *  V  AMM. 
i  a -N 
N 

m  ■  V  l  AMM. 
i  -  -N 

N  .  ’ 

02  -  S  i2  (AMM. -01/2  N*l) 

-  i  •  .  .  .  ■ 

1  ** 

ii.w  ia.i  1*5  reduced  to  a  recursive  form. 

01*  fl  01“  *  AMMul.O 

02*  ■  oa*-  01*  +  (N)  AMMUU> 


For  one  min  per  polhode  period  in  the  ANbhd  the  data  window  is  only  half  as 
wide  as  it  should  be  for  maximum  noise  rejection.  The  window  is  widoned  by  skip¬ 
ping  the  least  squares  filter  on  alternate  computation  cycles. 

b.  Phase  Tracking  Logic 

The  phase  tracking  logic  must  freeze  the  phase  variable  after  die  maximum 
|x>int  until  MUM  magnitude  drops  by  10  percent  of  the  peak-to-poak  value.  Thon 
the  phase  variable  is  reinitialized  and  extrapolation  is  begun,  Tho  angle  from 
trajectory  normal  to  MUM  vector  at  tho  max,  min,  and  90  percent  max  points  are 
shown  in  Figure  C’-l  for  0. 00  and  0. 0?  {icrcont  pendulosity  and  A  and  It  axes  respec¬ 
tively  and  45  deg  separating  polhode.  The  phase  at  the  90  percent  max  points  are 
approximately  20  deg  from  the  corresponding  max  points.  Tho  phase  variable  must 


LATITUDE  (D&>) 


figure  (M.  Angle  lletweon  MUM  Vector  and 
Trajectory  Normal  at  Min,  Max  and  90*1  Max 
Points  In  *€  and  +A  Families  (45  dog 
Separating  Polhode,  0, 00,  0. 07 
Pendulosity  on  A  and  DAxcs 
Uospoctivoly) 


he  extrapolated  70  tle^  from  the  90  percent  max  point  to  the  min  point.  The  extra¬ 
polation  frequenc  is  shown  i  ’  igtire  C-2  plotted  against  the  polhode  frequency. 

Also  drawn  on  the  flgur*  is  u..  approximation  to  the  extrapolation  frequency, 

1  Kxtrap*  vvhich  ts  tk?ni"  (l  t>s; 

F,.  .  -  i/T  ,  if  1/T  >  0.0549 

1.  xt  rap  p  p 

-  0.142,  if  l/T  *  0.0549 

A  flow  diagram  of  the  phase  tracking  meclumizntion  is  shown  in  Figure  tv 3. 

(1)  MIN  Kvent  (IDPT  -1) 

Ail  of  the  Ixtsie  computations  are  performed  at  the  min  event.  The  max  event 
is  primarily  used  for  data  collection.  This  is  because  the  minimum  is  always  well 
Miami  while  the  maximum  can  tie  quile  broad  and  Hi-defined  and  its  position  on  the 
jxdhodc  trajectory  varies  when  near  the  A  axis  as  shown  in  Figure  C'-l. 


Figure  C-2.  Kxtrapolation  Frequency  vs  Pothodc  Frequency 
(43  deg  separating  IVdhodv,  0. 03,  0. 07  IVtuUilosity 
on  A  and  U  Axes  Ilespectively,  7.90  sec  Polhode 
Period  Near  A  and  C  Axes) 
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TO  ttTi.-1-S 


Data  on  the  previous  two  min  and  max  amplitudes  and  the  time  of  the  previous 
two  min  events  must  be  saved  he  old  data  must  be  identified  as  that  which  occurred 
360  deg  back  in  polhode  phase  nom  the  most  recent  data  and  is  called 

PTO  =  time  of  old  min  event. 

AMXO  =  amplitude  of  old  max. 

AM  NO  =  amplitude  of  old  min. 

Also  the  amplitude  of  the  maximum  that  occurred  180  deg  back  in  polhode  phase  from 
the  most  x'ecent  data  is  identified  (AMXI). 

The  number  of  minima  per  polhode  period  is  stored  by  variable  NMIN  which 
can  have  value  1  or  2.  Choosing  the  right  value  for  NMIN  is  an  identification  function. 

Phase  lock  is  accomplished  by  remembering  the  sign  of  cos  phase  variable 
CT  at  the  previous  min.  This  is  called  CTO  which  can  have  value  ±1.  For  NMIN  =  2 
CTO  reverses  sign  at  every  min.  For  NMIN  =  1  CTO  keeps  its  same  sign  for  every 
min.  As  an  added  protection  against  phase  loss  in  the  terminal  conti’ol  mode  only, 
the  sign  of  CTO  with  NMIN  =  1  is  remembered  and  thereafter  CTO  must  have  the 
same  sign  whenever  NMIN=1. 

Compute  polhode  period,  TP,  and  extrapolation  frequoncy,  FE, 

TP  =  PTNO  -  PTO 
I'E  =  2  tt/tP,  TP  <  TPO 
=  2  tt/TPO,  TP  2  TPO 
where  TPO  is  a  program  constant. 

Initialize  the  sin  and  cos  of  the  phase  variable 
TH  =  (IDATA  -  PTNO)  (FE) 

ST  =  sin  (TH)  CTO 
CT+  =  cos  (TH)  CTO 
S2T  =  (CT)  (ST) 

Compute  peak  to  poak  MUM,  PP, 

■  PP  *  PEAKX-  PEAKN 

where  PEAKX  is  the  last  observed  max  amplitude  and  PEAKN  is  the  min  amplitude. 
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In  the  ANbhd  with  large  slopes  a  more  accurate  peak- to- 5x3 ale  computation  is 

PPAN  =  PEAKX  -  1/2  (PEAKN  +  AM  NO) 
if  the  rotor  was  not  torqued  during  the  last  polhode  period. 

Compute  the  change  In  max  and  min  values  over  3(>0  deg  which  Is  used  to 
represent  the  slope  of  the  max  and  min 

SMAX  =  PEAKX  -  AMXO 

SMIN  =  PKAKN  -  AM  NO 

The  difference  botwoen  the  two  maxima,  DMAX,  must  be  computed  both  with  and 
without  torquing  so  tho  slope  is  romoved  from  the  data 

DMAX  -  PEAKX  -  2(AMXI)  +  AMXO 

V.  hon  no  torque  has  been  applied  during  tho  data  taking  interval  tho  slope  does  not 
havo  to  bo  romoved  so 

DMAX  -  2  (PEAKX  -  AM XI). 

DMAX  is  twice  Amox  prosontod  in  Figure  t). 

To  avoid  false  minima  in  tho  transition  zone,  the  amplitude  of  the  minima  must 
bo  bolo\y  tho  previous  max  threshold  (AMMAX).  llowovor,  the  lest  cannot  bo  per¬ 
formed  in  tho  A  or  CNbhds  since  the  high  minima  may  not  bo  below  the  threshold 
value.  In  tho  C  or  ANbhds  large  torques  produce  significant  relative  chtutge  in  tho 
MUM  amplitude  and  ean  result  in  false  minima  at  the  Initiation  of  torque.  Therefore, 
apparent  min  events  that  occur  within  17  cycles  after  initiation  of  torque  in  A  or 
CNbhds  are  rejected.  The  sin/oos  extrapolation  is  restarted  at  a  min  event  by 
sotting  flag  IF  HZ  -  1. 

A  minimum  will  be  recognized  on  several  cycles  for  the  same  min  event.  Due 
to  noise  the  min  may  not  bo  recognized  on  consecutive  cycles.  A  series  of  minimum 
recognitions  will  be  assumed  to  compose  tlte  same  event  if  they  are  not  separated  by 
more  than  3  eyeles  with  no  minimum  recognized. 

(2)  Maximum  Event 

At  the  maximum  event  the  maximum  value,  AMPK,  is  saved  as  PEAKX. 

if  tho  maximum  threshold  (AMMAX)  turn  net  been  {tossed  amt  polhode  motion  is 
not  in  the  A  or  C  Nbhds,  the  phase  variable  is  frozen  at  its  current  value  by  setting 
flag  1FHZ  a  3.  The  maximum  threshold  is  computet) 

AMMAX  o  PEAKX  -  0.0G  (PEAKX  -  PEAKX) 
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where  PEAKN  is  the  previous  minimum  amplitude.  Then  if  the  current  MUM  ampli¬ 
tude  Is  less  than  the  maximuv  threshold  (AM MAX)  initialize  the  phase  variable  at 
4>t  +  90  or  +  270  deg  whichever  is  closest  and  restart  sin/cos  extrapolation  by 
setting  flag  IFRZ  =  1.  is  20  deg  as  shown  in  Figure  C-l. 

(3)  No  Event 

At  times  during  which  neither  a  maximum  nor  minimum  event  occurs,  phase 
tracking  is  concerned  with  extrapolating  the  phase  variable  and  determining  whether 
a  quadrature  point  was  crossed.  Extrapolation  is  not  performed  when  it  is  frozen  as 
determined  by  flag  IFRZ.  For  IFRZ  =  3  the  MUM  magnitude  is  compared  to  maximum 
threshold.  AM  MAX,  as  described  in  Para  C.  2.  b(2).  For  IFRZ  =  2  no  computation 
is  performed.  For  IFRZ  =  1  the  phase  variable  is  extrapolated  by 

ST+  =  (ST”)  cos  (FE)  +  (CT)  sin  (FE) 

CT+  »  (CT")  cos  (FE)  -  (ST")  sin  (FE) 

S2T  «  (ST)  (CT) 

C2T  -  (CT)2  -  .5 

A  quadrature  point  has  been  crossed  by  the  phase  variable  if  82T  reverses 
sign  during  the  extrapolation.  Froozo  the  extrapolation  (IFRZ  «  2)  if  a  quadrature 
point  is  crossed  and  if  either: 

1.  Polhode  motion  is  not  in  A  or  C  Nbhds,  or 

2.  Polhode  motion  is  in  A  or  C  Nbhds,  and  the  quadrature  point  is  0  or 
180  dog  (min  event),  and  it  has  been  300  deg  since  the  last  minimum 
event  was  recognized. 

The  reason  for  special  treatment  of  the  A  and  C  Nbhds  is  that  the  maximum 
events  do  not  always  occur  near  quadrature  points.  When  there  is  only  one  minimum 
per  polhode  period,  the  phase  variable  can  only  be  frozen  300  deg  after  the  minimum 
event. 


After  completion  of  plrnse  tracking,  the  program  always  transfers  to  the  control 
function  except  after  u  sequence  of  minimum  events.  Then  Ute  program  transfers  to 
identification  for  one  pass.  After  initialization,  identification  cannot  proceed  until 
sufficient  data  base  is  built  up  by  phase  tracking  to  compute  UMAX. 

(4)  Singularities 

Polhode  motion  has  six  singular  positions  which  are  spin  vector  along  the  *A, 

4 and  *C  axes.  Ute  occurrence  of  one  of  tltese  events  has  zero  probability,  however, 
an  operational  damping  mechanization  should  t>e  able  to  itandlc  them.  If  neither 
maximum  or  minimum  event  has  been  found  for  a  long  time,  PTMAX  computation 
cycles,  a  singularity  is  assumed  to  exist.  If  spin  vector  was  last  estimated  to  be  in 
the  ANbltd  with  +A  axis  identified  damping  is  complete.  Otherwise  reinitialize  auto¬ 
matic  damping  and  apply  C  family  torque  for  3/8  of  a  CNbhd  polhode  period. 
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3.  IDENTIFICATION 


The  dc.ta  generated  in  phase  tracking  which  consists  of: 


PEAKN 

PEAKX 

PP 

DM  AX 
SMIN 
SMAX 
TP 


minimum  value 
maximum  value 
peak- to- peak  value 

2  timos  difference  I k' tween  high  and  low  maximum 
slope  of  minimum 
slope  of  maximum 
pollmde  period 


is  examined  by  the  identification  routine  to  select  the  appropriate  control  law. 
Variables  UMAX,  KM  IN,  and  SMAX  are  not  always  valid,  so  logical  variables 
IDMAX,  ISMIN,  and  ISMAX  arc  established  to  indicate  when  the  data  is  valid.  The 
conditions  that  invalidate  the  data  are  listed  in  Table  CIU  together  with  thu  data  that 
is  invalidated.  The  concern  l?  that  enungos  in  tho  control  law  produoo  changes  in 
slope  and  bunco  invalidate  some  of  the  data. 


Table  CJ1L  Conditions  Under  Which  Identification  Data  Are  invalid 


Condition  tlui. 

Data 

Number  of  Polhodo 

Invalidates  data 

. 

Invalluated 

cycles  data  are  not  valid 

No  torquing 

KM  IN 

0.5 

KM  A.'  : 

1,0 

hdt  into  torc|ulng 

OMAX 

1.5 

Initiate  torquing  with 
polhodo  motion  in 
transition  /one 

KM  IN 

L,  0 

Hover st  c  Family 

DM  AX 

1.5 

control 

KM  IN 

1.5 

SMAX 

1.5 

Uovorse  A  Family 
control 

KM  IN 

2. 5 

i 

---  ■■■  -  - . — 

_ _ _ _ 

The  primary  purpose  of  identification  is  to  select  one  of  five  possible  regions  of 
the  rotor  that  contains  me  sp;  ecior.  The  regions  are  assigned  numerical  code, 
called  IF  AM: 

1.  CNbhd 

2.  C  Family 

3.  Transition  Zone 

4.  A  Family 

5.  ANbhd 

6.  Undetermined  region  (no  torque  applied) 

The  sixth  mode  indicates  identification  has  not  taken  place  and  is  used  for  initialization. 
The  A  and  CNbhd  regions  can  have  cither  1  or  2  minima.  Identification  must  deter¬ 
mine  the  number  of  minima  called  NMIN. 

Identification  is  performed  by  comparing  data  to  threshold  values  to  mako 
decisions.  The  threshold  values  arc  listed  in  Tablo  CII  together  with  a  brief  doscrii>> 
tion.  The  principals  used  in  establishing  tho  logic  are  briefly  listed: 

1.  The  transition  zone  is  a  symmetric  band  about  tho  separating  polhodc. 

Since  both  PP  and  TP  are  approximately  symmetric  about  tho  separating 
polhodc,  they  ore  used  to  defino  the  transition  zone, 

2.  Both  tho  A  and  CNbhds  are  identified  by  small  PP  values,  Tho  PP  value 
Is  always  small  when  NMIN  Bl,  A  and  CNbhds  ore  differentiated  by  tho 
magnitude  of  PEAKX. 

3.  A  change  in  NMIN  is  identified  by  the  conditions  of  the  A  or  CNbhds  plus 
an  observed  polhode  period,  Tp,  that  is  oltlter  too  largo  or  too  small. 

4.  Tho  A  and  C  families  consist  of  tho  leftover  regions.  A  portion  of  tho  C 
families  is  Identified  by  small  value  of  PEAKX.  Near  the  transition  zono 
this  is  unreliable  and  identification  is  based  on  DMAX.  if  DMAX  Is  not 
valid  identification  is  based  on  the  previous  family  identification. 

A  flow  chart  of  this  portion  of  the  identification  problem  is  shown  in  Figure  C-4. 
The  only  computation  Involved  is  that  necessary  to  change  NMIN.  When  NMIN  changes 
from  1  to  2  a  new  minima  has  just  appeared  on  the  MUM  waveform  and  there  is  no 
past  history  on  the  minima  so  identification  is  skipped.  Tito  polhodc  period,  TP,  is 
doubled  and  the  extrapolation  frequency  is  recomputed.  The  sign  of  the  phase  locking 
variable,  CTO,  is  reversed,  when  NMIN  changes  Irom  2  to  1  the  previous  minimum 
data  is  360  deg  old.  The  phase  tracking  data  is  recomputed  on  this  basis  as  described 
in  Para  C.  2.  b.  (1).  Identification  is  then  repeated  with  NMIN  «  l. 
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Figure  C-4.  Identification  1  Flow  Diagram 


The  number  of  min  can  main  at  one  very  deep  into  the  C  family  for  large 
pendulosity  components  on  A  B  axes.  A  constant  TP  threshold  for  recognizing  the 
change  of  NMIN  from  one  to  i .  o  is  not  adequate  as  can  be  seen  from  the  frequency 
plot  of  Figure  2.  Therefore  the  threshold  for  changing  NMIN  from  one  to  two  in  the 
C  family,  TC2X,  is  based  on  approximate  polhode  latitude  as  given  by 

TC2X  =  TC2  (1  +0.25  . 

The  polhode  period  near  the  A  axis  varies  significantly  with  rotor  temperature. 
Thresholds  TA1  and  TA2  should  roughly  obey  the  relationship 

TA1  =  (0. 75)  ATP 

TA2  =  (1.25)  ATP 

where  ATP  is  the  polhode  period  near  the  A  axis.  ATP  is  computed  by  the  program 
ATP  =  ATP  -  (0.3935)  (TP-  ATP) 

which  is  a  low  puss  filter  with  a  time  constant  of  two  Identification  cycles.  ATT 
is  only  allowed  to  have  values  in  a  limited  range  of  +25  percent  of  nominal  polliodo 
period  near  A  axis.  Figure  C-5  illustrates  the  NMIN  switching  logic. 

After  the  basic  identification  is  completed  several  special  cases  must  be 
resolved.  A  flow  chart  of  these  spoclol  cases  is  shown  in  Figure  09. 

a.  Identify  +A  Axis 

The  +A  axis  is  implicitly  identified  by  resolving  the  180  dog  uncertainty  In 
the  phase  variable.  The  180  deg  uncertainty  can  only  be  resolved  in  the  C  family 
(IF AM  -  2).  SON  is  a  variable  (*1)  indicating  the  estimated  sign  of  the  C  family. 

The  algorithm  is: 

1.  (1)M AX)  (SON)  >  0 

The  pliase  variable  is  near  0  deg. 

CT*  *  ICTl 
ST*  ■  IST“| 

CTO  «  1 

2.  (UMAX)  (SON)  <0 

The  phase  variable  is  near  180  deg. 

CT*  ICT'I 
ST*  *  -  ISfTl 
CTO  «  -1 
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Figure  C-5.  NMIN  Switching  Logic 


Figure  C-6.  Identification  2  Flow  Diagram 


After  the  +A  axis  is  identified  a  flag,  IPHAS,  is  sot 
IPHAS  =  1. 

b.  Identify  +C  or  -C  Family 

Tho  C  family  control  law  should  always  torque  to  move  out  of  the  C  family.  If 
the  sign  of  the  C  family  (SGN)  is  assumed  wrong  it  will  torque  into  the  C  axis  as 
indicated  by  a  negative  SMIN.  However,  In  the  C  Nbhd  the  polhode  trajectories  that 
do  not  enclose  die  pendulosity  vector  havo  a  negative  SMIN  when  moving  away  from  C 
as  can  be  soon  In  Figure  8.  Under  theso  conditions  the  sign  of  tho  C  family  must  bo 
determined  by  tho  slope  of  tho  max,  SMAX.  If  SMIN  and  SMAX  have  tho  same  sign, 
tho  polhode  trajectory  encloses  tho  pendulosity  vector  and  the  more  efficient  C  control 
law  can  be  used. 

If  tho  first  identification  of  automatic  damping  loeatos  polhode  motion  in  tho 
C  family  the  A  Nbhd  control  law  is  used  until  the  C  family  sign  is  resol  veil.  Tho 
correct  SGN  always  rosults  in  a  largo  positive  SMIN  or  SMAX  so  an  incorrect  SGN 
is  indicated  by 

SMIN  <  KPSC-N  or  SMAX  <  KPSCN. 

Since  SGN  was  previously  Involved  in  determining  the  +A  axis  tho  phase  variable  is 
in  error  by  180  deg  and  must  bo  corrected  whenever  SGN  is  reversed. 

When  automatic  damping  is  operating  correctly,  SGN  should  not  bo  wrong 
after  tho  first  Identification  of  tc  family.  If  a  later  oliango  in  SUN  is  required*  tho 
automatic  damping  has  gotten  lost  and  should  lie  restarted. 

c.  Torque  Out  of  A  Family 

If  the  +A  axis  has  not  toon  identified  (IPHAS  ~  0)  and  polhode  motion  is  in  the 
A  family,  tho  spin  vector  must  be  torqued  into  tho  C  family.  Therefore,  180  dog 
shifts  in  the  plume  variable  are  introduced  to  keep 

SMIN  <  KPSAN. 


d.  Prevent  Phase  Loss  in  A  Nbhd 

Once  the  polhotlc  motion  has  been  placed  in  the  A  family  with  the  +A  axis 
defined  it  should  not  bo  allowed  to  leave  tho  fumily  duo  to  automatic  damping  mal¬ 
function  resulting  in  plume  loss.  Therefore*  180  deg  slUfts  in  the  phase  variable  are 
introduced  to  keep 

SMIN  >  -  KPSAN. 

Tito  phase  loss  may  havo  toon  caused  by  terminal  control  gain  that  was  too 
lUgh,  If  tills  mode  is  outored  Ute  terminal  control  gain  Is  reduced  by  one  half. 
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e.  Detect  Crossing  off  the  Separating  Polhode 

In  the  transition  zone  tL  re  are  two  cases  based  on  the  polhode  region  (IFAM)  of 
the  previous  identification  cycle  that  must  be  considered. 

(1)  Previous  IFAM  /  6 

After  the  separating  polhode  has  been  crossed  there  is  no  longer  a  need  to 
apply  the  transition  control  law  which  is  only  half  as  efficient  as  the  C  and  A  family 
control  laws.  The  slope  of  the  max,  SMAX,  is  zero  in  the  A  family  and  nonzero  in 
the  C  family.  When  crossing  from  C  to  A  families  IPHAS  is  1  and  a  crossing  is 
detected  when 

I  SMAX  |  <  EPSMA. 

When  crossing  from  A  to  C  families  IPHAS  is  0  and  a  crossing  is  detectod  when 
|SMAX|  >  EPSMC. 

After  entering  the  C  family,  torquing  is  stopped  for  one  polhode  period  to  obtain  data 
to  identify  the  +A  axis.  The  C  family  sign,  SGN,  is  rovorsed  to  proparo  for  torquing 
out  of  C  family  after  +A  axis  is  identified. 

(2)  Previous  IFAM  =  6. 

If  poihodc  motion  is  on  the  C  side  of  the  transition  zone  aftor  a  period  of  no 
torquing,  the  +A  axis  can  be  identified  boforc  torquing  starts.  Polhode  motion  is 
on  the  C  side  of  the  transition  zone  if 

|  DM  AX  |  >  EPDS. 

f.  Terminal  Control  Functions 

Terminal  control  is  used  when  the  spin  vector  is  in  the  ANblul  and  the  +A  axis 
has  been  identified.  It  is  concerned  with  precisely  computing  the  peak- to- peak 
umplitude  for  use  in  proportional  control,  computing  tho  control  angle,  and  deter¬ 
mining  when  damping  is  complete. 

Tho  poak-to-peak  amplitude,  PP,  must  bo  corrected  for  slope  offects  due  to 
rotor  speed  changes.  When  tho  peak-to-peak  signal  is  large  relative  to  slope  the 
correction  is  based  on  average  SMAX,  ASMAX,  computed 

ASMAX  =  ASMAX  +  (0.  3938)  (SMAX  -  ASMAX). 

The  corrected  peak-to-peak  amplitude  is 

PP  =  PP  +  (ASMAX)  (TP)/ (2  NMJN) 

For  small  pcak-lo-pcnk  MUM  signal  the  corrected  PP  vaiuo  can  only  bo  obtained 
after  a  complete  polhode  period  of  no  torquing  in  which  cose  the  PPAN  computed 
in  paragraph  C.  2.  b.  (1)  is  tho  corroct  value  for  PP.  For  small  PP  values  the 
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untorquod  slope  must  be  given  to  the  least  squares  max/min  search  as  ISLOP  in 
paragraph  C.  2.  a. 

ISLOP  -  SMIN/TP 

if  no  torque  has  been  applied  for  one  polhode  period. 

If  the  +A  axis  has  been  identified  proportional  control  is  used.  The  desired 
angle  to  bo  torquod,  NANG,  is  computed  once  per  polhode  period.  Maximum  torque 
is  applied  immediately  after  identification  and  continues  until  the  dosirod  angular 
change  is  introduced.  No  further  torque  is  applied  until  the  next  identification. 

Angle  to  be  torquod,  NANG,  is  based  on  tho  estimated  polhode  colatitude. 
Polhode  colatitude  is  related  .o  peak-to-peak  MUM,  PP,  as  shown  in  Figure  07 
for  pondulosity  components  on  A  and  B  axos  of  one  percent  and  *15  dog  separating 
polhode.  Gain  variations  and  pondulosity  longth  variations  from  gyro-to-gyro  can 
be  eliminated  in  those  computations  if  normalized  peak- to- peak  amplitude  is  used 

PPN  «  PP/PEAKX. 

Figure  C-B  shows  the  A-C  plane  cross  section  of  a  polhode  trajectory  with 
colatitudu  AO  and  pendulosity  component  on  A  axis  of  sin  oft,  Tlw  figure  is  drawn 
for  u 

AO  <  Q0 

so  that  NMIN  «  1.  Tho  peak-to-poak  amplitude  is  then 
PPN  *  cos  (0Q  -  AO)  -  eos  (00  +  AO) 

»  (20o)A0. 

When 

AO  >  00 

so  that  NMIN  «  2,  the  peak-to-peak  amplitude  is 
PPN  a  l  -  cos  (AO  *  00) 

s  (AO  |  OQ)2 

Tho  colatitude  at  wltieh  NM  IN  changes  from  2  to  1  is 
AO  «  00 
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Figure  C-a.  Geometry  of  Pcak-to-lVak  MUM  Amplitude  in  ANUul 


m 


and  the  peak-to-jioak  amplitude  is 

rrN  -  2  6#2. 

Angle  Go  is  not  controlled  in  the  manufacturing  process  and  will  v:iry  considerably 
from  rotor- to- rotor.  On  a  perfect  rotor  O#  =  0.  However,  for  NMIN  =  2 

0  s  ypp  s  ySae 


so  that  control  angle,  AO^,,  is 


where  (*  is  Hu*  control  gain.  Maximum  control  is  applied  just  before  NMIN  changes 
from  2  to  1.  ANbhd  conti'ol  is  initiated  whon  the  spin  vector  is  nearest  the  It  axis. 

In  tliis  region  torqulng  effieioney  Is  70  percent  for  45  deg  separating  polhode.  There¬ 
fore,  C»  etui  Ik*  unity  without  danger  of  applying  more  than  100  percent  control,  Just 
liefore  NMIN  dianges  from  2  to  1  the  peak-to-poak  amplitude  PPV9  is  approximatoly 
described  *  “ 

oo  *  ^  /ppjo 


However  PI*n2  is  not  known  precisely  In'c  ttise  In  general  uneont rotted  slopes  due 
to  rotor  speed  dianges  corrupted  Uie  data,  Since  the  last  NMIN  *■  2  point  is  not 
recognized  until  the  first  NMIN  »  1  point  Is  obtained,  PPjjli  «n  accurate  pealido-pcak 
value  of  PPNi  etui  Ik*  obtained  by  apttlylng  no  torque  for  one  pollunte  period.  The 
problem  now  is  to  otitoin  tiq  in  terms  of  Pt^j.  The  conti'ol  angle  used  to  go  from 
PPN8  {°  Pi*M  Is  saved  as  A0c2.  Therefore 


0 


0 


atul  solving  for 


so  that  the  control  angle  Cor  NMIN  =  1 


aoc  * 


AO 


C2 


♦  4i _ ~ 


C2 


*  3  PP, 


N1 


i»p 


N 


This  mechanization  is  adaptive  in  that  the  gain  is  automatically  adjusted  for  0q 
without  requiring  0q  to  be  input  as  a  calibration  parameter. 
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The  control  angle  is  noi  malized  on  unit  torque  angle  which  on  tests  presented 
here  is 

66  =  unit  torque  angle  1/8  (max  torque)  (0.1  sec) 

The  normalized  control  angle,  NANG,  is 
NANG  -  A6c/ie 

The  proportional  control  mechanization  can  be  reduced  to  three  equations. 

For  NM  IN  -  2 


NANG  =  (GPAN2)  /PP^" 

On  the  first  XM  IN  =  1  compute  PP^,^  so  that 


GPAN1 


A0 


C2 


(GPAN2)^/2 _ 

+  'k,2  +  2  PPN1 


where 

1 

AGC2  =  /2  (NANGO)/GPAN2 

and  NANGO  is  the  previous  value  of  NANG  used  to  go  from  PPMO  to  PPX11 .  For 
NM  IN  =  1  **  m 


NANG  =  (GPAN1)  P?N 


GPAN2  is  a  hardware  parameter  and  is  defined 
G 

GPAN2  =  r~~~ 

■j2bQ 

The  not  control  gain  as  defined  by  AS^yAO  where  AG^-  is  the  total  control 
angle  over  one  polhode  period  and  AO  is  polhode  colatitude  at  tho  beginning  of  the 
period  will  be  computed.  First  for  NMIN  -  2  tho  first  control  angle  is 

AGa  =  (nG/  2)  /PP^" 

-  (  qG/2)  (A0±00) 

where  q  is  the  torquo  efficiency  as  shown  in  Figuro  14.  Assuming  tho  control  is 
accomplished  boforo  tho  second  min  occurs  which  is  at  colatitudc  AOj 

A0j  =  A6  —  A8^j 
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the  second  control  angle  is 


AeC2  -  (nivV2) 

=  (  •!  0/2)  (A6-  ABa  T0O, 

The  total  control  angle  AO^,  is  thou 

A®ct  =  A0ci  +  A0C2 

=  (  nG/2)  [a0(2  -  q  G/2)  +  0Q  V0/2] 

which  is  valid  for  A0  >  0Q.  For  NMIN  -  1  AO  i  Oq  the  gain  is  frozen  at  the  last 
NMIN  -  2  valuo.  Flguro  C**9  presents  the  input-output  plot  showing  tho  range  of 
possible  gains  that  can  occur  for  qG  =  1  and  the  large  variation  from  run  to  run. 
hi  practice  smaller  values  of  qG  must  bo  usod  since  q  is  unprodiotable  due  to  its 
phase  dependence. 

The  phase  variable  extrapolation  during  terminal  control  torquing  is  unstable. 
Tho  phase  variablo  is  used  to  direct  tho  torque  vector  and  track  tho  polhodo  motion, 
tf  tho  phase  variable  loads  tho  polhodo  motion  a  torque  vector  component  will  point 
in  a  direction  to  slow  down  tho  polhodo  motion  thus  increasing  the  phase  variablo 
error.  The  effect  occurs  throughout  tho  A  family  however  the  extrapolation  period 
is  so  shprt  and  tho  polhodo  motion  is  so  much  stronger  than  the  torque  that  the 
effect  is  negligible  except  for  u  small  region  about  tho  A  axis.  The  problem  was 
briefly  investigated  to  determine  if  any  real  danger  of  phase  loss  exists.  Starting 
with  tho  differential  equations  of  polhodo  motion,  Equation  (2),  lliu  motion  in  tho 
ANhhd  whore  Is  essentially  constant  is 

wil  "  “KU  U,C  +  1  fl 

we  '  Ke  Uu 

whore 

KU  C  WA 

K  „  A-.n 
KC  C  WA 

and  torque  defined  by  tho  A  control  law 
Tjj  B  T  cos  $ 

Tc  »  T  sin  $ 

$  “  phase  variable. 
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Transforming  into  an  olipticai  coordinate  frame  with 
1 

WB  =  y/^C  r  008  * 


“C  =  yic:  r  sin  * 


gives 


4>  =  J 


+  IM 


sin  (4>  -  $) 


r  =  -  R  $)  cos  (<}>-$) 


where 


j  .  Vkb  k  c 


U(4>) 


'/cos2  $  ~~  +  sin^  4> 
Kc 


lHmse  variable  $  is  extrapolated  by 

$  -  $ 


Tlu)  phase  variable  error  during  extrapolation  and  control,  &4>»  is  given  by 

.  6*  «'  6J  +  sin  (6<fr) 

6J  s  J-J 

It  can  Im  semi  tluit  o<t>  has  an  unstable  equilibrium  at  zero  and  a  stable 
equilibrium  at  ISO  deg  which  supports  itse  intuitive  observation  made  earlier.  <‘>4>  bus 
been  evaluated  numerically  for  various  conditions  of  initial  phase  error,  H(o), 
frequency  error,  6J,  Initial  distance  from  A,  r(0)» and  torque  magnitude,  T.  The 
number  of  degrees  of  freedom  were  hirthor  reduced  in  the  numerical  evaluation  by 
normalization.  The  largest  error  at  the  end  of  the  control  period  was  HO  deg  which 
was  caused  by  an  extrapolation  frequency  error  of  0.  a  rad/control  period  plus  a 
20  deg  initial  phase  error  and  applying  100  percent  of  estimated  control.  As  an 
added  precaution  control  is  not  apjilltKl  if  the  phase  variable  has  been  extrapolated 
more  titan  270  deg. 

Termination  of  polhodc  damping  is  based  solely  on  the  peak** to- peak  MUM 
amplitude.  A  tlireshold  is  set  that  Is  just  above  the  noise  level.  The  peak- to- peak 
amplitude  must  be  tauter  the  threshold  for  two  consecutive  t>olhode  periods. 


4.  CONTROL 


The  control  function  in\  ■  ives  computing  the  appropriate  control  law  and 
commanding  the  appropi  iate  motor  currents  in  the  spin  motor  control  electronics. 
The  control  law  commands  2  degrees  of  freedom,  the  amplitude  of  torque  and  direc¬ 
tion  of  torque  in  a  plane  orthogonal  to  the  spin  vector.  The  control  law  computes 
three  scalar  quantities 

TORQ1  =  cos  6 
TORQ2  =  sine 


FLUX 


J Desired  Torque 
Max  Torque 


where  Amplitude  is  the  desired  torque  amplitude  and  6  is  the  angle  from  MUM 
voctor  to  torque  vector  measured  about  spin  vector. 


a.  C  Family  Control  Law 

The  C  family  control  law  applies  maximum  torquo  along  ±  MUM  vector. 

TORQj  “  -SGN 

touq2  =  0 

FLUX  =  1 

b.  CNbhd  Control  Law 

The  basic  control  law  is  the  same  as  the  C  family  control  law  except  torquo 
is  not  applied  continuously  under  all  conditions.  Polhode  trajectories  very  close 
to  the  C  axis  do  not  onclose  the  pendulosity  vector  and  so  iorquing  can  only  be 
performed  near  the  max  value  of  MUM  magnitude.  If  tiro  sign  of  the  C  family  is 
wrong,  continuous  torquing  will  slave  the  spin  vector  to  be  colinear  with  the  pendu¬ 
losity  vector.  Doth  difficulties  can  be  overcome  with  a  simple  mechanization.  At 
each  identification  compute  tbrcsltold 

CM  AX  =  PKAKXold  -0. 25  (PEAKXol{]  -  PEAKN) 

where  PEAKN  is  the  value  of  MUM  min  last  observed  and  PEAKX^id  is  the  value  of 
MUM  max  two  observations  ago.  tVhen  initially  starting  up  CM  AX  is  the  value  to  be 
observed  on  the  next  max  event  reduced  by  2.5  percent  of  the  pcak-to-poak  value. 
Start  torquing  and  contiuuc  to  torque  as  long  as 

AMM  >  CM  AX. 


If  after  torquing  has  been  initiated  the  above  inequality  fails,  further  torquing  is 
prohibited  by  sotting 


CM  AX  »  1 


until  the  next  identification  period.  This  prevents  limit  cycling  that  might  otherwise 
occur.  If  the  C  family  sign  (SGN)  is  wrong  the  inequality  will  fail  after  torquing  for 
1/16  soc.  Subsequent  identification  will  resolve  the  SGN  error. 

o,  A  Family  Control  law 

The  A  family  control  lnw  applies  maximum  torque  whilo  rotating  the  torque 
vector  with  respect  to  MUM. 

TOlUj.  *  CT 
TOllQg  *  ST 
FLUX  *  1 

d.  Transition  Zono  Control  Law 

The  transition  zone  control  law  must  bo  compatible  with  oitlier  C  or  A  family 
politode  motion.  When  CT  and  SGN  ore  of  opposite  sign 

TOUQj  -  (CT  -  SGN)  (5/8  -  1/8  CT) 

TOUQg  «  (ST)  (5/8  -  i/8  CT) 

FLUX  •  1 

and  when  CT  and  SGN  arc  of  same  sign 
TOHQj  ■ l'OKQg  *0. 

o.  ANblut  Coturol  Law 

If  the  +A  axis  has  not  boon  identified  the  ANhhd  control  law  is  identical  to  the 
A  family  control  law.  Control  is  only  applied  for  half  a  polhode  period. 

When  the  +A  axis  has  been  identified  control  is  applied  as  in  the  A  control  law 
except  the  duration  of  torque  is  adjusted  to  correspond  to  the  control  angle  command, 
NANG. 

f.  Rate  limited  Torque 

The  rate  of  change  of  torque  Is  limited  to  avoid  large  transients  lit  the  magnetic 
flux  field.  Torque  Is  quantised  by  the  unit  torque  which  is  i/8  the  maximum  torque. 
Torque  is  raised  mid  lowered  by  one  step  change  per  computational  cycle. 

118 


-v^rc Vf*a^r»j-ja'i»us  ;ui»»iHiWw. — w  f*  :;■*■>  fW*v,c zsbumxvk' 


This  mechanization  does  not  appear  to  be  necessary, 
g.  Spin  Motor  Control  Eloctx'onics  Commands 

Spin  motor  control  commands  consist  of  three  vectors  og#  pg,  vs  where 

og  =  |  (TORKj)  +  (TORKg)  P'N|  FLUX 


Ps  =  ( (TORKj)  p'N  -  (TOHK2)o£j  |  FLUX 

Vs  =  |vN|  FLUX 

and  o^,  p^r,  Yj\j  corresponds  to  vectors  oN ,  pN,  computed  in  Para  C,  1  with 
no  phase  shifts  introduced  by  the  electronics.  The  net  phase  shift  introduced  by 
both  MUM  readout  electronics  and  spin  motor  control  electronics  is  compensated  by 

«  cos  *  oN  +  sin  4)  pN 
P^  =  sin<t>oN  +  cos^PN 


where  i  is  the  nominal  phase  shift  inherent  in  the  electronic  design. 


If  the  x,  y,  and  z  gyro  motor  coils  exhibit  a  scale  factor  unbalance  or  axis 
misalignment  they  can  be  compensated  by  a  (3x3)  matrix*  C*y.  The  spin  motor 
commands  would  consist  of  vectors  o',  pg»  yg  whore 


s  v» 


If  this  compensation  is  used  it  would  only  be  a  nominal  compensation  based  on  an 
ensemble  of  gyros*  Individual  calibration  of  the  motor  coils  is  not  intended.  Motor 
eoil  compensation  was  not  used  In  the  tests  reported  hero. 

5*  INITIALIZATION 


Initialization  of  course  is  performed  at  the  beginning  of  poihodc  damping.  There 
are  also  two  conditions  under  which  reinitialization  is  performed.  They  are: 

1.  C  family  sign  reversal  occurred  after  the  initial  sign  determination  was 
made.  Automatic  damping  Is  lost.  Reverse  the  C  family  sign  tutd 
reinitialize.  (Para  C.  3.  b. ) 


2.  The  separating  polhodo  was  crossed  from  A  to  C  and  the  +A  axis  has  not 
been  identified.  Reverse  the  C  family  sign  and  reinitialize.  (Para  C.  3. 3.  (1). 

After  reinitialization  data  is  taken  for  one  complete  period  before  identification 
and  further  torquing.  Aftor  the  original  initialization,  data  is  taken  until  three  minima 
are  found  before  identification  and  initiation  of  torquing.  The  original  initialization 
must  accumulate  17  data  points  before  the  maximum/minimum  search  can  begin. 


APPENDIX  D 


AUTOMATIC  POijHODE  DAMPING  SUBROUTINE  LISTING 


The  IBM  1130  Fortran  subroutine  CNTLR  listed  here  is  called  from  an  executive 
routine  10  times  per  second  based  on  an  interrupt  clock.  MUM  data  is  read  and  MUM 
magnitude,  AMM,  is  computed  by  the  executive  before  calling  CNTLR.  CNTLR  speci¬ 
fies  direction,  TORQ(l)  and  TORQ(2),  and  magnitude,  NTQ,  of  torque  to  the  executive. 
The  executive  sends  the  torque  commands  to  the  spin  motor  control  electronics. 

Other  variables  used  to  communicate  with  executive  are: 

(1)  PARAM  =  a  general  parameter  list  25  elements  long.  Each  of  the  elements 
is  defined  in  the  listing.  The  values  used  for  the  automatic  damping  tests 
are: 

PARAM  (1)  96. 

(2)  0. 0001 

(3)  0. 34 

(4)  3056, 

(3)  0.015 

(6)  0. 3935 

(7)  80. 

(8)  0. 1 

(9)  8. 

(10)  0. 

(11)  0.02 

(12)  0.008 

(13)  2. 

(14)  0.004 

(15)  0,002 

(16)  0.3935 

(17)  0. 

(18)  2.5 

(19)  2.5 

(20)  2, 

(21)  04. 

(22)  <06. 

(23)  *9. 

(24)  h\  . 

(25)  20i. 

(2)  JGAIN  specifics  the  MUM  filter  time  constant. 

(3)  JMODE  specifies  special  test  modes 

5M(?DE  2,  MUM  Phase  calibration  mode 

*  4,  No  Torque  is  applied 

*  5,  Normal  mode. 


121 


(4)  M#DE  specifies  automatic  damping  modes 
M0DE  =  1,  Initialization 

=  2,  Normal  Damping  Mode 
=  3,  Damping  Complete 

=  4,  Print  automatic  damping  data  alter  damping  complete 
=  5,  Stop  torquing 

=  6,  Undamp  from  an  equilibrium  point. 

Two  assembly  language  subroutines  are  called  from  CNTLR. 

(1)  LSTSQ  (ISI.OP,  IBOC,  IPK,  JPK,  IDPK) 

LSTSQ  mechanizes  the  max/min  search  of  Para  C.2,a  where 

IBOC  (JU.5  ISL()P)/C 

AMFK  -  IPK  (6.4  X  KT5)  >  JPK  (10.7  x  I0~10) 

LSINT  is  the  Initialization  entry  for  LSTSQ 

(2)  SICOS  (ITU,  ISIN,  ICOS) 

.  SICOS  is  u  sin/eos  routine  where 
ITIi  ■  0  2l5A  (input) 

ISIN  =  sin  (0)  2U  (output) 

ICOS  -  cos  (0)  2*  *  (output) 

One  Fortran  function  routine  willed  from  CNTLU  is 
PE  *  m'itP  (TP,  FEO) 
wliere 

TP  is  the  polhode  period 

FIS  is  the  pliase  variable  extKqtolatlon  frequency 

FED  is  dummy  variable  not  used. 

The  eomputloa  for  FE  in  Ito  C.  2.  b.  (1).  is  mechanized. 


t*PtoHa 


i>ot 

So* 


//  FOR 

•LIST  SOURCE  P\OGRAv 
•  ONE  i\JRQ  IMF  GMS 

SUHROUTImE  CML'< 

R E A L  LAG 

D!M\$IO.a  ID  \T  (9  »15G>  »FI;)’.T(  7 1 1 5  3  ) 

DT'E^SlGN  PT  -"\  (  2  >  •  A  • . '  >  (  P  )  *  A  X  (  e  ) 

CO  viVOix  TORO  (  2 )  *M  Ot  DA^AVt  it  3  )  #  A‘«i  • » JGAI\»  *iODE  f  J  <10Dfc 

DATA  P<vsT»P<LST/6*A<.v9A&AE-5»I'>.SS36«C422E-iC/ 

DATA  P 1 5 » R 1 4/ 1 043  3 ♦ 3  7H  35  *  6 • 1035 1 5o3fc"5/ 

DATA  CSLW.P/1069547E?./ 

DATA  RIO  /9. 7656251-4/ 

DATA  CPK*TK*  X  »P»C,/ .  05  » ?C .0  ♦  •  2 5 / 

C  Tl*E  LAG  P('R  NEw  '■'AX  /  M\ 

DATA  v\N;C»V,\XC/-2  »-fi/ 

C  FILTER  TwRFASHOLD 

DATA  P»FLT/*0C?/ 

c 

PARAV(17)«-1 

GO  TO  <  10 1 1 200 1 200» 340  •  700  *  1 V9 )  *•'  ODE 
C  SHUT  DO'vN  VODE 
700  NTQD-0 

10ATA»IDATA+1 
GO  TO  e93 

C  VQDf,  6  -  UNDAMJ  F  <UV  tv»l/ 1 1 IflisU"  »*OIM 

199  IF  UDATA-IDATSI  195  *196*196 
195  IOATA-IDATA+1 
GO  TO  ROO 

INITIALIZATION 

101  CONTINUE 

TVAX*PARAV(1» 

PPF»UARAV(2I 
AVAX«PAQAM(3> 

GPA(\2»PA«AM(4) 

AMAP«PARA'M5) 

G3i»OP*PAR  AM  <61 
MA,NG*PARAM(7I4.5 
avtp*paravi ei 
ATOVA«PAHA>U9)»*5 


123 


P,AGE  2 

PHASE-PARAMUO) 
EPDSaPAPAM(ll) 
EPDMA*PARA.X(  12) 
oPHAS»PAr<AM13) 
t.PSCN=PARAM(  14) 
EPSAN-PARAM15) 
f,TP*PARAM(  16) 

ID2  =  PARAV.(18) 

I  DO-PARA'-:  (  19) 

,\PR  NT*PAPA.V(20) 
TA10*PA«ANM21) 
TA?OaPAPAv { 2? ) 

T Cl  -PAHA’  t  23  ) 

TC2  -PARA'  i  (  2  A  1 

PTvAX=PAaAM{25) 
N-ODEO? 
ir>ATl*C 
MVIi\2  =  0 
A  TP-T  A 10/ .75 

I  p  r  *  o 
■)PT»0 
WTQD-0 
\WIND-1? 

CAUL  LSIXT 

GO  TO  (161*162) *IOC 

161  cr-i. 

CTO-1. 

SQ*I»-1  • 

GO  TO  163 

162  CT  — 1. 

CTO— 1. 

CT1*CT0 

SGN-l. 

163  CONTINUE 
ST-O. 

PTMN-t 1 ) -0. 
PTVN(2)»0. 

os-o. 

DC-i. 

PE-O. 


I1  ACC 


-» 


ft  :?«0* 

C**X»Sr.lTHVX««C17*;3'3» 
S  -  X*CCf .(TH^X*«,'>;74»2  2  ) 
S?vx*«2«*Cv**S  a 

v  »x*l 

I  ■'  A  T  A  *  w 

n>»  i 

\F?«1 

m.»c 

i«6 

JCiAI\»1? 
i.Ac«*5 
nrNT—l 
I  F  A 

ISATjMOATA+MiJ'iO 

»tm*i*:atA4PTmax 

JVAX«C 

<vAA«2 

l*.0  Sf:\***5G\ 

IPAV.fc 

>A  vGO*C 

ISIG*:»S 

IwlOK-O 

\SL0P«0 

TAluTAlO 

TA2«TA?0 

!2FNT*lDF\T-l 

aS*'AX*C 

IGPAN»1 

%**,1W 

|0’AX*1* 

A0'*AX«? 

|$*AX»C 

<SVAX*1 

tS*‘lN*0 

<v**i<N-o 

JPHAS*0 

GO  TO  *901*902**102 


sss 
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901  I PHA5*  1 

902  CONTINUE 
GO  TO  791 

C 

c  PHASE  T NAC<1NG 

200  CONTINUE 

IF  llpATA-PTNl  1  190 ♦  190 » 1 91 
C  NO  MIN  CAN  HF  FOUND 

191  IF  ( I  PH AS  5  192*192*193 

193  IF  UFAV-5I  192*194*192 

192  <iUDE«6 
1DAT$«IDAT*WC1**5 

I F  AM ■ ? 

GO  TO  300 

C  DAMPING  COMPU  TE 

194  MODE  •  1 
GO  TO  «00 

19Q  CONTINUE 

IF  UVOOE-SI  110*111*111 

110  ISMAX«C 
ISMIN«0 

111  CONTINUE 
iOATA-IOATA+l 
KNX«MhX*l 
.VN‘U*MN  .♦! 

ISLCP-NSLOP 

i$K!0*tWlOE#M03!lOA?A*2) 

IF  C I  S*f  l I  3.12*302*202 

302  CAul  L S T SO < I  SLOP . I flOC , I PX  *  JP< » I  OPT  1 
IF  riAtfEI  303*303*305 

305  I HOC « I HOC* l ^OC 
J3AI,N*16 

4AG«*9«$ 

303  IF  UOPTJ  201*204*203 
C  NONE 

204  continue 

202  00  TO  1205*230*206)  *IFf»2 
2CS  CONTINUE 
C  SIN/COS  UPDATE 
sro«st 


126 
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S2TO*S2T 
ST* ST  *DC+CT*DS 
CT=CT#DC-$TO*DS 
S2T=  ST«CT 
C2T*CT*CT-u  5 

IF  ( S?T*S2 TO )  207*207*250 
C  A/C  !n8H0  LOGIC 

207  CONTINUE 

GO  TO  (208*210*210*210*208*208)  *IF A >'i 

208  IF  ( C2T )  253*253*209 

209  IF  (CT#CTO )  250*250*210 

210  IFR2=2 
PARAM  < 1 7 ) =0 • 

r  LIMIT  TORQUE:  FOR  270  DEC-  -  A  imBHD 

253  IF  (ST*CTC)  254*254,250 

254  \ANG«0 

250  CONTINUE 

IF  ( IDEKT*(1-ISKIP)  )  800*600*251 

251  IF  (MNN’J  POC 1 800  *252 

252  I  DENT-0 
GO  TO  400 


C 

C 

206 

C  PAX 
214 


VAX 

203 


IP  (  av.M-APMAX  i  214*214*250 
THREASHULD 
I FRZ“1 
PNXeMNXO 
CT*-CMX*CTC 
ST«SVX*CT0 
S2T«S2MX 
PARAV ( 17 ) *1 #  5 
GC  TC  250 
;  POINT 

PEAK Xs  IPK#PKI'ST+JPK#PKLST 

JMAX*1 

STX«ST 

IF  (MNX)  202*220*220 

GO  TC  ( 202 *221  * 22 1  *221  *202  *2C2  )  » 1  FA*‘ 
CONTUSE 

IF  (  (IFRZ-311  752*753*752 


".■a- 


752  PAR AM ( 17  )  *1 #5 

753  CONTINUE 
IFRZ=3 
CT«0. 

ST=CTO 

AM,«'AX»PEAKX«DP'<M  PEAXX-PEAKN ) 

GO  TO  206 
C  MIN  POINT 

201  peaxn»ipk.*pkmst+upk#pklst 

GO  TO  < 230 •  301  •  3(3-1  •  301  *230*230)  *IFAM 
301  IF  (PEAICN-AMMAX)  230*2  30*202 

230  IF  ( MNN)  232*232*231 

231  IF  UDATA-10AT2)  202.202.233 
233  CONTINUE 

TPOLD-TP 

IDENT«IDENT+i 

ID1-I0 

ID-MODI ID.2 )+l 
IDO»MOD( I0-NMIN+1»2)+1 
IF  UFAM-6J  261*262*261 

262  AMMXUOOJ-PEAKX 
261  CONTINUE 

IF  IMMIN-U  263*263*264 
264  CTO—CTO 

263  CONTINUE 
PTO»PTWii 1001 
AMXO-AMMXUDO) 

AMNO-AMMN( IDO) 

AMXi-AMMXUDl) 

AMMX ( ID)«PEAKX 
PARAM ( 1 7 ) ■ 1  *  5 

I MAX ■ JM AX 

XMAXaXMAX-fJMAX 

JMAXaQ 

IOAT2aIOATA«*NWlNO 
,  MNN»MNNO 

PTNOa  IOATA-IBOC45UO-LAG 

PTNlaPTNO^PTKAX 

TPaPTNO»PTO 
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F£«FXTRP ( TP«F£0 ) 

IFE*FE*P15 

CALL  SI  CCiS(  IFE»ISI\*ICCS) 

0S=ISIN«R14 

0C*ICCS*R14 

1Th»  ( IDATA-PTKO  )  *  IFf. 

CALL  SI  CCS  (  ITH«  I  SlM»  lC'LS ) 

ST«ISIN«R14#CT0 

CT«IC0S*R14«CTC 

S2T*  ST«CT 

PP»PEAKX-PEAK.i\ 

PPA\«PEAKX-IPEAX  \+A'-‘.»0  !  *  »5 

svax*pf.akx»amxo 

SVI\*PF.A<\-AK,MO 
D'^AXx'PF AXX-AVX  1-/*  <iXl+AVXC 
PTv«\t  ID)»PT.\0 
A  (  ID )  »PEA<\ 

GO  TO  H00 
C 
C 

C  IDENTIFICATION 
C 

C  FAMILY  IDENTIFICATION 

400  CONTINUE 
C 

C  PHASE  ADJUST  VUDE 
C  JWODE  •  2 

IF  lJNODE-2)  401*402 *401 

402  PHASE»PHASE-GPHAS*SM1N 
TQRQl 1 1 «S IN < PHASE ) 

TORO  <  2 1 »*COS I PHASE  I 

ntgd»ntqmx 

IPT«lPT4l 

FIDNTUilPTI-PHASE 
FtONTI2«IPTl«SMIN 
IFUPT-150I  403*405*405 
405  MODELS 

403  GO  TO  R90 

401  CONTINUE 
C 


129 
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IF  (6-IFAM+KMAX)  491*192*491 
491  CONTINUE 
SMINP»SMIN 

idat?*ioata 

c 

PPN*PP/PEAKX 

GO  TO  (511*510) iNMIN 

511  IF  (PEAKN-AKAX)  512*513*513 

512  IF  (TP-TC1)  514*514.515 

513  IF  (TP-TA1)  514.514*515 
C  CHANGE  NM IN  1  TO  2 

514  NMIN*2 
NMIN2-1 
CTO—CTO 
CT.-CT 
ST*-5T 
TP«TPQLD 
FE»FXTRP(TP*FEO) 

I F£«FE*P1 5 

CAU  SIC0S(  1  PE  *  l  SIN*  ICGS ) 

0$-ISIN*R14 
0C«IC0S*R14 
I0MAX-0  . 

ISMAX-0 
NANG-0 
GO  TO  471 
C 

510  IF  (PEAKX-AMAX)  521*521*522 

521  GO  TO  524 

524  TC2X«TC24TC2**25*PEAXX/AMAX 
IF  (TP*TC2X>  523*525*525 

522  IF  (PPN-AMAPI  525*526*627 
627  IF  (TP-TMAXI  527*504.504 

526  IF  (TP-TA2I  516*525*525 

527  IF  (10MAX)  529*529*528 

528  IF  (ABSiOMAX  l-EPDSJ  530*530. *23 

529  60  TO  (525*525*304*550.530*528) *1FAM 

CHANGE  NMIN  2  TO  1 

525  NMIN«1 


u  u  u  u  u  u 


PAGt 


.9 


N2S 


TP»PT\0-PTV.,\(I31) 
pFsFXT«P<  TPtrEC J 
IF  (\MIN2*ItJA*&SJ  625»62E>»626 
6?i  CTO  — CTO 
626  IF-^PC*P1S> 

CALL  SI  CDS  ( IFF.  •  I S I  ■'*  I  CuS ) 
DS*ISM*R1* 

X*!CGS«'UA 

ItH«t PATA“PT\G>*IpF 

CALL  SlCOSUTn*  lbl  .*  ICOS) 

STdSI  vMH*CTv 
CT*  I  CCS*1'  1*»*  0 

f*PAN«PFA<  X-(‘‘LA<  ,+A'  <Ul  I D X  )  )*»5 
5  >  '  I  » *  P  F  A  X, 1 ,  “  A  .  (  *  C 1  ) 

S'tAX**:' 'A^X-A'  •  I  I  L>  1 1 
oG  TO  ill 


IDF  JIFV  SPLCIAL  CASCS 

T9A  .SIHC.  IC'.i 
5M4  Cv.TI.Ll 

if  A  ‘6«  I  fc'  A'-*-f 
l  F  A  •  •  V 
I  ..iDE*: 

.\SlO*»«* 

IF  (IF  A‘*6  1  AA2  »  iAf) 
i*U?.  IF  (JS''mX)  <#hA#M*6»MO 


C 

C 


<4  LA  *L<*L  *159 
339»!?3C»alm 


•^ETlCT  0.*?SI\L  OF  Thl  SLHAiATl  «G  I'lLHvDl 
la3  le  U{,,,AS>  5A3*S“3»i<*L 
IF  tAPMSMAXI-^OS  > 

&aa  IF  .UR5(S*‘aAXI»C*^vai 
TV.mMTIC.  RFGIDN 
5l5  <$*. 

IT  {At*6(D‘.*AX  aal*<*a<.*23** 

AAA  Cw\T  !  >ilt 

IF  UPnASi  4fcCt<*6C«<*50 


C 

il&  IFAv«l 


1 


m 
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DMAX»1. 

SMIN-SMAX 
GO  TO  616 
C 

C  C  FAMILY 
523  IFAM*2 
C 

C  LOCATE  +A  AXIS 
C  C  NBHD  LOGIC 

616  IDC«M0D(1D-MMIN»2)M 

CMAX-AMMX  { I  DC ) -( AMMX  UDC  )-PEAXU  >  *PPCiM 

IWIDE-C 

N5L0P-0 

IF  USIGfi  )  617*617*618 

617  IFAM-1 

GO  TO  6?1 

618  IF  (SMINP-EPSCK)  62l»620*620 

620  IFAM.2 
8MIN«SVI.NP 

621  IF  (IDVAXi  450*450*234 
C  3ES0LVF  180  DFG  UNCFUTAJNTY 

234  IF  (DMAX  #SGN)  2)5*235*236 
C  LOW  MAX  IP'iASE  ■  190  DEG) 

235  CTa-ADS(CT) 

ST—ARStST) 

CTO— 1 

GO  TO  237 

C  HIGH  MAX  IPmASE  -  0  DEG) 

236  CT*AAMCT) 

ST»APSIST) 

CTO*  1 

237  IPHAS*1 
STX«-CT 

450  CONTINUE 
C 

C  I0ENTIFY  +C  OP  -C  FAMILY 

IF  (ISMI'l  )  470*470*451 

491  IF  (SMN-EPSCN)  452*452*453 
452  IF  USIGN)  454*454*150 
454  5S*i»«$Ci  j 


132 


n  o 


15  AGP  U 

CTO*-CTO 

CT--CT 

ST»-ST 

STXs-STX 

ID‘*'AX«C 

KD^AXs? 

1 SVAX»C 
<SVAX»2 
ISV!\»0 
<SV  Ii\«2 
453  I S X Q.\ *  1 
GC  TC  4*»C 


0cc  *% 


I 


ij 

{j 


I 

5 

f 


A  NHM2 
516  I  FAV«5 

IF  UP^AS)  946»946»94? 

946  \A  t3«\TQ‘-X*TF/2. 

GO  TO  460 
94?  .'Pw«PP 

UK«;»p+A$\AX*TP/{?*Y  1  W 

C  •  ••.•*««**■***«#*•«•«.*<»<*<*• 

IF  (PPI  265»2h6»i66 

265  PP«0« 

GO  TO  927 

266  C0  4T!  \;l£ 

IF  (V.IN-U  927»927»9?a 

927  I WlOF* 1 

928  COM  I  \U 
PP\«PP/PEA<A 

C 

C  P9GI'U!<T  10' 4L  CU'‘(T’J>.fc  GAl  *S 

IF  tV  IWGPAM  921*v45.922 
92?  *PP«*S(29T»PPi\i 
;«A\G  ■GPA.\2*PPP 
CT1-CTC 
GO  TO  923 
945  1GPAN«3 

0TMC*\A.\G0/<2.*GPA»?* 
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GPAN1-0* 

921  NANG  «GPAN1*PPN 

IF  (NMIN-l)  943*943*923 

943  CT0*CT1 
923  CONTINUE 

C  #####*##***»************ 

C  IF  UMAX)  938*938  *941 

941  IF  (NANG-MANG)  936*939*939 

936  IF  (PTNO-IDAT1-TP)  938*937*93? 

930  NAMG«0 

GO  TO  940 

939  ASMAX*ASMAX4-GSL0P<MSi'’AX/TP»ASMAX) 

PP«PPO+ASMAX»TP/I  2*N  '-IN) 

NSLOP-O 
GO  TO  942 

937  ASMAX-SMIM/TP 
pp.PPAN 

NSLOP»ASMAX*CSLOM 
IF  IGPANl)  944*944*942 

944  GPANl«GPAN2/(0THC4SQRTl0THC*t)lHUPP/PtAlCX) 

942  CONTINUE 
C 

£  #*#**»#»*»**#»»»******** 

IF  tPP)  1263*1266*1266 

1265  PP«0. 

GO  TO  1927 

1266  CONTINUE 

IF  INMIN*1 )  1927*1927*1928 

1927  IWlOE-l 

N5L0P«NSUiP4NSUeP 

1926  CONTINUE 

PPN*PP/PEAKX 

C 

C  PROPORTIONAL  CONTROL  GAINS 

IF  (NMIN-IGPAN)  1921 *1921 *1922 
1922  RPP*SORT(PPN) 
aANG  «GPAN2*kPP 
GO  TO  1923 
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1921  NANG  •GPAi\il*PPN 
1923  CONTINUE 


C 

C 


c 

c 


c 

c 


NF1«NF2 

NF2«1 

IF  ( (PPN-PPF)*IPHAS»  930*931*931 

930  NF2*0 

931  IFINmIN-1)  934*934*933 

934  \Fi*\F2 

935  IF  (NFUNF2J  932*932*933 
i)AvP  I\G  COMPLETE 

932  NOOE*VODEC 
>'OOEC«3 

GO  TO  94C 

933  vOOEC*2 
940  CONTINUE 

I0AT2«I0ATA+KWl\0 
NANGO-NANG 
GO  TO  460 

A  FAVjly 
530  IFAv.4 
t;vIDE«0 
nSL0P«0 


460  IF  (ISMM  463*463*466 
466  IF  (IPMASI  468*468*467 
TOmiUE  OUT  CF  A  FAMILY 

466  IF  (SM!N-EPSAK)  463*462*462 

prevent  p«A$r  loss  in  a  nbhd 

467  IP  (S- IN+EPSAN)  465*463*463 
465  3PA\?«r»PA;<2**5 

GPA\l»GPANl**5 

lo«AN*l 

18CDEG  PHASE  SHIFT  TO  UNOApP  A 
46 2  CT*-CT 

st*-st 

CTO*-CTC 
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IS4IN-0 
<SMIN«4 
463  CONTINUE 
C 

470  CONTINUE 
NVIN?*0 

471  CONTINUE 

C  SET  TA1  AND  TA2 

ATP«ATP+GTP*(TP-ATPI 
IF  (ATP-TA20)  474.474*475 

473  ATP«TA20 

474  IF  (ATP-TA10)  472*473*473 

472  ATP*TA10 

473  TA1 aATP#* 73 
TA2«ATP#1.25 
IFAM()»IFAV 

IF  (PP-PPFLT)  561 *362.562 

561  JGAINa15 
LAG»4.5 
GO  TO  563 

562  JGAIN-12 
LAG-, 6 

563  CONTINUE 
C  SET  FLAGS 

KDFL-3-NVIN 

itmx»o 

IF  UD**AX)  601*601*602 

601  IOvAX« 1 

602  <OPAX«KDMAX-KOEL 

IF  <KS'*AXI  603*603*604 

603  ISVAX-1 

604  KS‘->AX*KS*iAX-KDEt 

If  US6‘IM  605*605*606 
6J5  1$>*IN*1 
606  XS^IN-XS^IN-KDEL 


OUVP  DATA 
701  I SON "SON 
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ICTO-CTO 

ATORK-NANG 

ATOROATORX/NTQMX 

PSMAX*AS>AX*1COO. 

IF  (NPR  .NT )  915*915*916 

915  CONTINUE 

IF  (IFAm-51  911*912*911 

911  WRITE  (-1*3001)  IDATA,IFAv*\MlN*IPHAS»IU.-tAX»lS.>  AX»ISi*'.Iis*IS5.\*ICTG» 
X  TP*PEAXN*PEAKX»P»*  DMAX*SKAX*SMN 

3001  FORMAT (!6t£l2*FB*2tlOF#*5) 

30  TO  913 

912  -*R  I TE  1 1  *  3002  )  I  DATA  *  I  FAN!  *KM  \\  ♦  I PHAS » I  DMA*  •  I SNAX » I  ftMl  h  *  I  SGN  *  I C  T  u  * 
X  TP»PEA<N*HEA<X*PP*PSMAX  *S>VAX*SMI.\»  GPA-U*ATORk 

3002  FORMAT! I6»hI2 *F8. 2 »2Fa«5»E9***3F6*5.2C9*i) 

GO  TO  913 

916  IPT«|PU1 

IF  (IPT-150)  919*919*920 

920  \PT«IPT 
1PT-1 

919  CONTINUE 

ID  NT ( 1 ♦ IPT I » I  DAT A 
ID  NT ( 2* IpT ) *1  FA • 

ID  NT  ( 3*  I PT  )  ■NMJ 
ID  NT ( A* !PT ) »J PHAS 
ID  NT (5* IPT )*IOVAX 
ID  iNT  ( A*IPT  )  »I  S^'AX 
ID  NT(?*IPT)«IS‘IN 
ID  NT  I R » I  AT )  »I  SG-s 
IDNT(9»IPTI«ICT0 
FIDNT(1*IPT)«TP 
F 10NT ( 3* IPT ) *PEAXX 
Fn\T(A»IPT)«PP 
FIDNT (6* IPt )«SMAX 
FID  NT  ( T.  IPT )  »5VI*( 

IF  (IFAM-5J  917*918*917 

917  FIDNT(?*IPTI«PCAXN 
FIDNT (5* IPT l*OvAX 
GO  TO  913 

91R  P 1 0.\T  1 2 » I PT )  "ATORK 
F IONT ( 5  * IPT  I •PSMAX 
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913  CONTINUE 
CONTROL 

900  CONTINUE 

IF  (JNODE-2)  881*890»881 
8Hl  CONTINUE 
NTQO*NTQMX 
CPaCT 
SP*ST 

GO  TO  (80i»8C2#803»ttC4i805i806) »IFAM 
C  C  NBHO 

901  IP  (AMW-CMAX)  806*811*811 
HU  IC<BD«l 

C  C  FAMILY 

302  T0RQ(1>«-S  ON 
TORO ( ?  )  *0 » 

GO  TO  890 
C  TRANSITION 

803  IF  (SGN*STX)  806*806*813 
813  TRAN«.6?5-*125*AB$(CP) 

•TORO  (1)  ■  I  CP-SCN I  *TRA\ 
T0RQ(2>»SP*TRAN 
GO  TO. 990 
C  A  FAMILY 

H04  TORO (1) "CM 
T0RQI2I-SP 
GO  TO  890 
C  A  NBHO 

803  .OANG».\A.iC»-UTO*UTC+lU/2 
NTQD*NTO 

IF  INOA.NG)  816*817*818 

816  NT0D»NT01M 
IDATUIOATA 
GO  TO  BIT 

818  IF  (NOANG-NTO)  817*819*819 

819  IF  (NTQ-NTUf'xl  820*917*81?' 

820  NT:10*NTQ0+1 

817  NANG* NAnC-N TOD 

IF  (NANG)  821*822*822  ‘ 
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821  NANG«0 

822  TORQ l 1 ) *CP 
TORQ ( 2 ) BSP 
GO  TO  890 

C  UNDETERMINED  FAMILY 
806  NTQD«0 

IF  CICNRD)  827*827,826 

826  CMAX=1. 

!CNRD«0 

I  OAT  2*  I  DA  TA+NW I  .NO 

827  CONTINUE 

IF  ( IFAVu-31  802*813,804 
C  RATE  LIMITED  TORQUE 

990  IF  (T0RQU)*T0R31-fT0Kvi(2)*T0R02 )  897,89 9*898 
997  IF  (NTC1  894*899*894 
894  TORCH  i  )  b-TORC5(  1 ) 

TORO ( 2 >*“TORO ( 2  I 
NT3D=0 
GO  TO  896 
899  -T0R01*T0«C(1I 
T0902bT0'-<(H2) 

996  IF  (NTONTGD)  391*892*893 

891  NTC«\TG*1 
GO  TO  892 

893  ,\TO«SlYO-l 

892  CONTINUE 
RETURN 

C 

C  DUMP  DATA 

340  IF  t NPT-IPT J  341,342*342 

341  NPTelPT 

342  CONTINUE 

DO  350  1*1 *NPT 
IF  (JVODE-2J  343,344*343 
344  WRITE (1,3004)  F I ONT  ( 1  *  I )  *F  l  ONTi  2  *  I J. 

3004  FORMAT l 2F 8.5) 

GO  TO  330 

343  CONTINUE 

IF  (ID  Nt(2*I)-51  351*352,381 
351  WRITE ( 1*3G01 ) ( ID  NT ( J*l J  * J*l*9) * (FlDKtCK* I J  *N*1*7) 
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GO  TO  350 

352  **R  I TE  (  1*3003)  <  10  NT( J.I  )  *  J*1  »9  )  »  (  FIONT  { K*  I  )  tK-ltl) 
3003  FO'<v,AT(  I6»8l2»FiJ.2tK8.3»FS.5»ty.<i»4Fe.5»2£9»2) 

350  CONTINUE 

WRITS  <1»3005J  I  OAT  A 
3005  FORMAT  P  DA.'- PI  NG  Tr:i‘*  16) 

.  RETURN 
END 

FEATURES  SUPPORTED 
ONE  WORD  INTEGERS 

CORF  REQUIREMENTS  FOR  CMTLit 
CUWO\  62  VARIABLES  3712  PROGRAM  3312 

RELATIVE  ENTRY  POINT  ADDRESS  IS  0ED5  (HtX) 

END  OF  COMPILATION 


140 


REFERENCES 


1.  C 70-972/201,  Micro -Electrostatically  Suspended  Gyro  (MESG)  Fast  Reaction 
Study,  August  1970,  Unclassified. 

2.  Tou,  Julius  T. ,  "Modern  Control  Theory,"  McGraw-Hill,  Inc.  New  York, 
1964. 


1 


’9»qqc«eeM^aSKif«*a^?j&MV»*W»l&V&^3m4g*5^^ 


f: 

l 


t 

l 

\  • 

i 


I 


DISTRIBUTION  LIST 


DD  Center,  Attn:  1  >C-  •■  JA 
Cameron  Sta.  Bldg  > 

Alexandria,  Va  22314 

Commander 

Naval  Elect.  Lab  Center 

Attn:  Library 

San  Diego,  Ca  92152 

AFAL 

Attn:  AFAL' DOT,  ST1NFO, 
WPAFB,  Oh  45433 

Capt,  R.  R,  Warzvnski 
AFAL/NVA-GGGA  ‘ 

Wright- Patterson  AFB,  Ohio 

Ofe  Asst.  Sec  of  the  Army  (ll&D) 
Attn:  Asst  for  Research 
Room  3-K-379,  The  Pentagon 
Washington,  D.C.  20310 

Hq  DA  (DAHD-ARP/ 

Dr.  R.  Watson) 

Washington.  D.C.  20310 

CO,  U.S,  Army  Missile  Command 
Redstone  Scientific  Info  Center 
Attn:  Chief,  fjocument  See. 
Redstone  Arsenal,  Ala  35809 

Commanding  Officer, 

Pfeatinny  Arsenal, 

Attn :  SMCPA-TYI 
Dover,  N.J.  07801 

Commanding  General 
U,  S,  Armv  Electronic  Command 
It,  Monmouth,  N.J.  07703 
AUn:  AMSEL-MS-TI 

A15ABE  -  Commanding  General 
U.S.  Armv  Electronic  Command 
Bldg  2504 

Ft,  Momnouth,  N.J.  07703 
Attn:  AMSK1.-VL-NS 
Mr.  Ray  Clark 


2  copies 


l  copy 


1  copy 


1  copy 


1  copy 


1  copy 


1  copy 


1  copy 


2  copies 


4  copies 


UNCLASSIFIED 


SECURITY  CLASSIFICATION  OF  THIS  PACE  fWi«n  D.t.  F.nintd) 


REPORT  DOCUMENTATION  PAGE 

HEAD  INSTRUCTIONS 

BEFORE  COMPLETING  FORM 

1.  REPORT  NUMBER  1.  OOVT  ACCESSION  NO 

K  COM-0230- F 

»•  RECIPIENT'S  CATALOG  NUMBER 

4.  TITLE  (»nd  Submit) 

Automatic  Polhode  Damping 

Investigation  for 

Micro  Electrostatic*  Gyi*o 

S.  TYPE  OF  REPORT  A  PERIOD  COVERED 

Final  Technical  Report 

1  July  1972  through  23  May  197: 

t  PERFORMING  ORG.  REPORT  NUMBER 

7.  AUTHORS) 

John  C.  Wauer 

B.  CONTRACT  OR  GRANT  HUMBERTO 

DAAB07-72-C-0230 

t.  PERFORMING  ORGANIZATION  NAME  AND  ADDRESS 

Hockwell  International 

Autonetics  Division,  3370  Miraloma  Avenue 

Anaheim,  California 

10.  PROGRAM  ELEMENT.  PROJECT,  TASK 
AREA  A  WORK  UNIT  NUMBERS 

II.  CONTROLLING  OFFICE  NAME  AND  ADDRESS 

Fort  Monmouth  Procurement  Branch 

United  States  Army  Electronics  Command 

Fort  Monmouth,  New  Jersey 

1*.  REPORT  DATE 

.June  1973 

IJ.  NUMBER  OF  PAGES 

156 

ft” MONITORING  AGENCV  NAME  S  AOORESSTU  dlUtmtl  Item  Cwtlfollfns  Oifl<-«> 

IS.  SECURITY  CLASS.  <ot  Hilt  » poH) 

Unclassified 

Tti.  DECLASSIFICATION'1  DOWNGRADING 
SCHEDULE 

f«.  nlTNiauTioN  statement  (hTiai<  N«r«i) 

Distribution  limited  to  U.S.  Government  agencies  only.  Teat  and  evaluation, 

June  1973,  Other  requests  for  this  document  must  bo  referrod  to  Commanding 
(lenernl  U.H.  Army  Electronics  Command:  Attn:  AMHKL-VL-N-S, 

Ft.  Monmouth,  N.J.  07703, 

II  DISTRIBUTION  STATEMENT  («l  IA*  M  Bltth  20,  If  tUIttftml  turn  Rtport) 

l»  SUPPLEMENTARY  NOTE* 

II.  REV  WORDS  fCoMlnu#  aft  III*  IlMNMRT  IBwUtfF 

Automatic  Polhode  Damping,  Polhode  Motion,  Polhode  Peri  oil,  Electrostatically 
Suspended  Gyro,  Herpothodc,  Conformal  Maying,  Target  iteturn 

It.  aestract  tcmttm*  m  »•****•  ,'4»  iImiiimt  l***ntr  *F  «»** 

A  computer  program  for  automatically  damping  the  polhode  motion  of  the 

Micro- Electrostatically  .Suspended  Gyro  (MKSG)  Is  presented.  Test  results  arc 
presented  that  demonstrate  successful  automatic  polhode  damping  on  t«u  gyros. 

The  fundamental  characteristics  of  polhode  motion  of  the  ME  SO  rotor  are  summa¬ 
rised.  The  techniques  for  monitoring  polhode  motion  using  Mass  Unbalance 

Modulation  (MUM)  are  described.  The  polhode  torqulng  equation  Is  derived  and 
the  spin  motor  control  electronics  that  Implement  the  torqulng  equation  are  described 

DDijmVW*  *0.rtoN0F  inov»*.so»sol«t«  UNCLASSIFIED 


security  classification  of  tM^  PAciT**^  o*»< 


